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ABSTRACT 


Doppler  radar,  compass  heading,  and  VLF  communications  station 
phase  difference  information  are  combined  in  an  optimal  fashion  to  form  an 
integrated  navigation  system  based  on  the  concepts  of  Kalman  filtering.  A 
ten-state  Doppler/VLF  Kalman  filter  navigation  algorithm  is  designed  for  ust‘ 
onboard  the  NAE  Convair  580  aeromagnetics  research  aircraft,  with  simula¬ 
tion  studies  conducted  using  computer  programs  written  in  FORTRAN  for 
the  IBM  3032  TSS  operating  environment.  Results  from  the  studies  show  the 
unique  features  of  a  Kalman  filtering  approach  to  the  navigation  task. 
Various  contingencies,  or  anomalous  situations,  that  can  arise  when  handling 
the  VLF  data  are  considered,  and  solutions  are  offered  in  the  context  of  the 
Kalman  filter  approach  being  used.  A  comparison  study  involving  simulated 
navigation  data  demonstrates  the  superiority  of  the  Kalman  filter  navigator 
compared  to  simpler  navigation  algorithms,  especially  when  significant  l>ias 
errors  occur  in  the  basic  quantities  being  measured.  A  further  comparison 
study  based  on  navigation  data  collected  onboard  the  Convair  verifies  that 
the  proposed  Kalman  filter  navigation  algorithm  operates  properly  when 
using  typical  ‘real  world’  data. 


SOMMAIRE 


Des  donnees  de  radar  Doppler,  de  cap  au  compas  el  d('  dephasagi* 
entre  stations  de  telecommunications  VLF  .sont  coml)inees  de  fai,-on  opti- 
male  dans  un  nouveau  systc'me  de  navigation  integre  fonde  sur  les  principes 
du  filtrage  Kalman.  On  a  en  effet  elahore  un  algoritlime  de  navigation  pour 
filtre  Kalman  Doppler/VLF  a  dix  etats  utilise  a  bord  de  I’aeronef  de  recher¬ 
che  aeromagnetique  NAE  Convair  580;  des  etudes  de  simulation  ont  ete 
menees  a  I’aide  de  programmes  informatiques  rediges  en  FORTRAN  pour  le 
milieu  de  fonctionnement  du  systeme  TSS  IBM  3032.  Les  resultats  de  ces 
etudes  font  ressortir  I’apport  unique  du  filtrage  Kalman  dans  un  systeme  de 
navigation.  Diverses  contingences  ou  anomalies  pouvatil  se  presenter  lors  du 
traitement  des  donnees  VLF  sont  mises  en  twitlence,  et  des  solutions  faisant 
appel  au  filtrage  Kalman  sont  propos<*es.  line  etude  c-omparalive  portant  sur 
des  donnees  de  navigation  simulees  d«>montre  la  supenorite  du  iiavigaleur  a 
filtre  Kalman  par  rapport  ii  des  algorithmes  de  navigation  plus  simples,  sur- 
tout  lorsque  se  presentent  rles  <>rreurs  non  centrei-s  importantes  dans  les 
grandeurs  de  base  mesurees.  line  autre  etuile  comparative  reposant  sur  des 
donnees  de  navigation  r'*cueillie.s  a  bor<l  du  Convair  confirme  I'efficacite  de 
I’algorithme  de  navigation  pour  filtre  Kalman  lorsque  des  donnees  typiciues 
et  ‘reelles’  sont  utilisees. 
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- 1  - 

A  KALMAN  Fll.TER  APPROACH  TO  NAVIGATION  ON  THE 
NAE  CONVAIR  580  AEROMAGNETICS  RESEARCH  AIRCRAFT 

1.0  INTRODUCTION 

The  NAE  Convair  580  research  aircraft  has  onboard  various  navigation  aids,  including 
Doppler  radar,  C-12  compass  heading,  VLF  station  phase  difference  information,  LORAN-C,  OMEGA 
station  phase  difference  information,  a  Litton  LTN-51  inertial  navigator,  and  the  possibility  of  a  GPS 
(Global  Positioning  System)  receiver  at  some  time  in  the  near  future  (Refs.  1  and  2).  With  so  much 
redundant  navigation  data  available,  it  is  important  to  try  to  use  it  as  effectively  as  possible.  A  Kalman 
filter  approach  (or  some  extension  of  it)  becomes  almost  esssential  in  such  a  situation  in  order  to 
‘blend’,  in  some  optimal  fashion,  the  various  types  of  navigation  information. 

At  the  Flight  Research  Laboratory,  a  study  was  initiated  in  May  1978  to  look  at  a  simple 
Doppler/VLF  navigation  filter  employing  the  Kalman  filter  technique.  The  purpose  of  this  study  was 
three-fold; 

i)  to  gain  an  understanding  of  basic  Kalman  filter  concepts  through  analyzing  a  relatively 
simple  version  of  a  Kalman  filter; 

ii)  to  compare  the  Doppler/VLF  Kalman  filter  to  the  Doppler/VLF  complementary  filter 
being  used  at  present;  and 

iii)  to  demonstrate  the  possible  advantages  of  the  Kalman  filter  approach  for  otiter  applications 
at  Flight  Research  —  a  multi-sensor  hybrid  navigation  system  and  aircraft  attitude  sensing 
are  just  two  of  the  possibilities. 

2.0  THEORY  OF  KALMAN  FILTERING 

The  mathematical  tht'ory  behind  th(‘  concept  of  Kalman  filtering  involves  probability  and 
statistics  together  with  linear  systems  theory  in  a  state  vector  formulation.  In  this  c  hapter,  the  basic 
theory  will  la-  outlined  very  briefly  many  refenmces  are  available  for  a  more  complete  analysis  of 
the  theory  (e.g.  Ref.  is  an  excellent  textbook  on  the  subjc'ctl. 

2.1  Elementary  .Statistical  Concepts 

References  t  and  5  serve  as  a  very  good  source  for  gaining  a  <)uu  k  understanding  of  the 
undc'rlying  principles  of  a  Kalman  filter.  In  its  very  .sim|)lest  form,  the  Kalman  filtcTing  process  con¬ 
sists  of  combining  two  independent  estimates  of  a  random  variable  to  form  a  weighted  average.  The 
o[)timal  wi'ighting  factor  is  chosen  so  as  to  [iroduce  a  weigh t(>d  average  having  the  luiniiniun  rariuncc. 
Let  xl  and  x2  be  two  independent  estimates  of  a  Gaussian  random  variable,  x.  having  variani  es 
I  -  anil  .  -  respectively  ( si'e  Ref.  (i  for  basic  statistical  definitions!.  Furthermore,  assume  that  x2 
IS  estimated  by  measuring  y2  h  •  x2.  where  y2  has  the  vananci'  '  h  ’  •  ii^  ,  ’ .  Now,  a  general 
form  for  the  wi'ighted  average  of  xl  and  x2  wimld  be. 


X  (1  K  •  III  •  xl  +  K  •  h  •  x2 


(  1  K  •  hi  •  xl  ♦  K  •  y2;  t)  K  •  h  -  1 


with  K  •  h  the 'weighting' on  x2  and  (  I  K  •  h  I  I  he ’weight  mg' on  x  1  K  i-- the  weighting  factor 


-  2  - 

From  Kquation  (2.1),  the  statistical  expectation  (i.e.  mean  value)  of  x,  E(x),  can  he 
expressed  as. 


E(x)  =  (1  -  K  •  h)  •  E(xl)  +  K  •  E(y2)  (2.2| 

By  definition,  the  variance  of  x,  - ,  would  be. 

a^-  =  k{[x-  E(x)]-|  (2.:)) 

The  followinf*  expansion  of  Equation  (2.3)  can  then  be  developed: 

0,-  =  e|[x-  E(x)]-}  =  e1[(1  -  K  •  h)  •  xl 

+  K  •  y2-  (i  -  K  •  h)  •  E(xl)  -  K  •  E(y2)]-| 

=  E I  [( 1  -  K  •  h )  •  ( xl  E( xl ))  +  K  •  ( y2  -  E( y2 ) )]  ’  I 


=  e{(1  -  K  •  h)-  •  [xl  -  E(xl)]-  +  K-  •  [ 

y2-  E(y2t]- 

2  •  K  •  (1  -  K  •  hi  •  [xl  E(xl)]  •  [y 

2  -  E(y2)]| 

=  (1  -  K  •  h)-  •  e|[x1  -  E(xl)]-|  +  K-  • 

E|[y2-  Kl.v2) 

+  2  •  K  •  (1  -  K  •  hi  •  e|[x1  E(x1)]  • 

[y2-  Eiy2i]| 

Now.Ejjxl  E(xl)l‘  ly2  E(y2)ll  0  t)ecause  xl  and  y2  ^  h  •  x2  are  assumed  lo  lie  independ^ 
I'lit  estimates:  hem'c.  I  xl  -  E(  x  1 )  1  and  1  y2  ^  E(y2ll  “  li  •  1x2  E(  x2)  1  must  he  uneorrelated.  1  he 
expansion  of  ’  then  reduces  to 


-  -  ( 1  K  •  hi’  •  '  +  K-  '  I  2.,') I 

I'o  determine  the  minimum  variance.  (5^  ’ .  as  a  function  of  weifihtinj;  factor,  K .  sim pl\  different  lalc 
Kquiition  12.5)  with  respect  to  K  and  set  tin-  result  to  /.cro.  I  hus. 


i)(>  ■ 
\ 

hK 


2  •  h  •  (  1  K  •  hi  I  -  +  2  •  K  •  o,  ^ ' 


( 2  ( ;  1 


I) 


which  yields  the  optimuiu  value  of  K,  K,  as 


3  - 


K  = -  (2.7) 

-  (-  h-  •  I  - 

From  Kquatioii  (2.1 ),  the  expre.ssion  for  the  best  estimaU',  x,  can  be  written  as, 

X  =  (1  -  K  •  h)  •  xl  +  K  •  h  •  x2  =  xl  K  •  (h  •  xl  y2l  (2.8) 

and.  from  Eciualions  (2.5)  and  (2.7),  the  expression  for  the  varianie  of  x,  - .  liet  omes. 

-  =  ( 1  K  ■  h)-  •  I  '  +  K-  •  1  - 


h-  •  (I, ,  -  +  0, 


■  •  "> 

h-  •  o  .  -  +  0, 


h  • 


h-  •  (),  I  -  +  a, 


■  0, 


(2.di 


1 


IK 


h-  •<),,-+ 


I  -  •  ( 1  K  •  h)  -■  (i^  I  '  K  •  li 


If  one  assumes  that  y2  "  li  ■  x2  is  a  measuri'ment  useti  to  improve  an  updated  estunatt'.  xl  .  then 
K(|uations  ( 2.S)  and  ( 2.b)  uidteate  just  liow  the  estimate  and  its  v;U'iance  ;ire  iniiirov  ed  by  the  measure 
)nent. 

2.2  State  V  ariable  Formulation  for  a  Linear  Kalman  Filter 

In  order  to  ai'ply  Kalman  filtering;  techni(iue  to  any  (lartieular  physical  |irohlem  iiuoKinit 
a  dynamic  process,  the  equations  of  motion  of  tin'  firoces'  must  lie  cxpressixl  in  a  state  \ari,dile  formu 
lation.  witii  any  random  noise  proei'sses  ineludeil  as  well  the  undi'rlyintt  statistical  tlieory  will  lie 
tliat  of  a  Markov  process.  Furtliermori'.  samplevi  data  viTsions  of  tlie  various  equations  will  lie  used  in 
order  to  relleet  tile  more  prai'tical  situation  of  havinu  to  deal  with  mi'asurement  data  m  dental  form. 
First,  a  scalar  I  i.e.  omMlimensional )  Kalman  filter  will  be  rlcveloju'd  to  outline  tlie  Irasie  principles  of 
state  varialile  formulations  and  .Markov  processes;  (lien,  an  extension  to  tlie  p'mieral  mnltialimensional 
Kalman  filter  alitorillim  will  take  place. 

2.2.1  Scalar  Kalman  Filler 

In  tile  eii'-uine  mathematical  development  a  ’-ysteiii  slate'  formulation  is  assumed,  in  which 
I  he  act  ual  a  ale  ( d'  I  lii'  pliysii  ai  sysiem  is  to  lie  estimated  Us  111^1  a  Kalman  filter.  An  ailernat  ive  to  this 
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would  be  the  so-called  ‘error  state’  formulation,  in  which  it  is  only  the  error  in  the  p^u•ticular  process 
state  which  is  to  he  estimaUKl  via  a  Kalman  filter  (see  Ref.  5  for  an  interesting  example  of  an  error 
state  formulation). 

.Assume  a  first-order  physical  system  exists  in  the  form  of  a  Markov  process  (see  Ref.  3  for 
definition),  as  follows: 

Xk  +  i  =  4  •  Xk  +  Sk  *  “k  (2.10) 

where 

X|^  ^  true  state  of  the  t)rocess  at  time  t,. 

f|^  ^  transition  term  representing  the  dynamics,  or  eejuation  of  molitm. 

of  the  system 

U|^  :  random  noise  in[)ul  with  z<‘ro  mean  anti  viiriance  (||^ ,  assumed  to  be 

(laussian 

g|^  -  scalar  multiplier  reflecting  the  effect  of  the  random  noise  i)roccss.  u. 

on  the  state  x 

Kcluation  i  2.10)  is  known  as  the  [ilant  e()uation,  with  u,^  the  .so-called  plant  noise. 

.\s  well  as  a  scahir  plant  eqtiation,  it  is  assumed  that  a  mi’asuri'inent  |)rocess  exists  in  which 
the  cpiantity  being  nn'asured,  y.  is  some  linear  functiott  of  tne  slate  of  lh('  system.  Thus. 

VkM  =  •  x,.,,  +  (2.11  I 

where 

yi^ti  quantity  being  measured 

h|, I  -  scalar  multi[)lier  reflecting  the  relationship  between  the  measurement 
and  the  sUite 

Vj^ ,  I  -  random  measurement  noise*  with  /.e-rej  mean  and  variaiu-e  . 
a.ssLimed  tej  be  ('■aussian 

K(|Uation  (2,11)  is  called  the*  ob.se’rvation  (eer  me-asurementl  e-e]ualion,  with  ,  the*  obse'rvaliein  (or 
measurement)  neiise*.  Note*  that  ,  g^^  ,  h^^ .  eij^ .  anel  r|^  are*  all  allejwe-d  to  vary  from  one*  sam|)le'  time  to 
the*  ne’xt  in  this  feirmulatieen. 

In  e)rete'r  to  re-late  this  first-e)rde'r  me-thematieal  de-ve-loimie-nt  to  what  was  eliscove-red  in 
Se-ction  2.1  (i.e-.  abeiut  optimally  e  ombining  an  update- anel  a  me-asure-me-nt).  it  is  ne-e cssary  to  e'X|)ress 
the-  variance  e)f  the-  U|)elate-,  p|^  .  preipe-rly.  For  this  (lurpeise-,  ele-fine-  the-  follejwmg  eiuantili<-s: 

X|^  be-st  e-stimate-  of  the-  true  slate-  after  k  sanqile's  e)f  d:ita 

Xil ,  I  stale-  upelate-  base-d  em  x,^ ,  i.e.  X|[ ,  ,  ^k  ’  H 
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Pk 

Pk.i 


variance  of  X|^ 

variance  of  the  update  j 

random  error  in  Xj^ ,  namely  -  Xj^ 

random  error  in  xj^  ^  i ,  namely  xj^  ^  j  “  ’‘k  + 1 


The  best  upxlate  from  the  plant  equation  can  be  expressed  as, 

*k+  1  =  ^k  ’  ^k  "  ^k  *  <*k  ^k>  "  ^k  ■  ^k  ^k  '  ^k 


‘k.i  -  Sk  -“k  fk  *^k 


(2.12) 


Since  Xj^  ^  j  represents  the  true  value  of  x  at  tj^  +  , ,  the  error  in  xj^  +  ,  ,  ej^  +  j ,  must  be 


^k  +  1  -  ’^k  +  1  *k  +  1  ‘  “k  ^  ^k  *  ^k 


(2.13) 


Also,  the  variance  of  ej;  + , ,  var  |  + , }  ,  is  precisely  the  variance  of  xj^  + , ,  p^  + , ,  because  x^  +  |  =  E( xj^  + ,  ) 

(i.e.  the  true  value  has  no  variance,  by  definition).  Therefore, 


Pk+i  =  varje;,,  |  =  var  •  u^  +  f^  •  e J 

=  varj-g^  -u^}  +  var  jf^  •  e^  | 


(2.14) 


because  u,^  and  Cj;  are  assumed  to  be  independent  random  processes.  With  var  {  u,^  (  =  ,  and 

var{e|j[  =  var  {x|(}  =  p^ ,  Equation  (2.14)  becomes. 


Pk^l  =  •  Pk  ^  '^k 

=  fk  •  Pk  ’  fk  * 


(2.15) 


It  is  now  possible  to  make  comparisons  based  on  the  previous  developments  of  Section  2.1.  At  step 
k+1  identify 


xl 

-  ’‘k  +  l’ 

«. 

a 

III 

=  fk  '  Pk  •  fk  ^  gk  *  ^k  *  8k 

y2 

=  Vkn  ’ 

“  ''k  +  1  ’ 

(2.16) 

x 

"  *k  +  1  ’ 

A 

K  = 

Kk>l 

r 
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Kqiiations  (2.7),  (2.8),  and  (2.9)  from  Section  2.1  can  llicn  be  rewritten  as. 


K 


and 


= _ _ 

‘\.i  •  •  “k.l  ^  ■'k. 


-(^.1  -  Vk.i) 


Pk.i  =  I’k.:  -  ^k.i  ‘''k^i  ■ 


(2.17) 


(2.18) 


(2.191 


respectively,  'riius.  the  (jest  estimate  of  the  first-order  .system  stat('.  .  and  its  variance,  P|^ ,  can  l)e 
updated  for  minimum  variance  at  eacli  step  by  sequeni'ing,  recursively,  through  the  following  so-called 
Kalman  update  equations; 


^k.i  =  fk-^k 


t’k. 


k+  I 


^k  '  Pk  '  fk  +  ^k  ‘  ^k  •  ^«k 

Krh  =  PkM  •  '[hk.i  •  Pk^i  •  ‘\.|  ^  h^i] 

’^k  H  "  ^k  +  I  '  (^k  +  I  '  ’^k  +  1  "  ^k  +  l) 


-  I 


'■k  +  1 


plant  update 


variame  of  update 


Kalman  gain 


optimal  state  estimate 
after  k  +  1  samples 


(2.20) 


Pk  +  1  Pk  H  ’^k  +  I  ’  +  I  ’  Pk  +  I 


variance  of  optimal 
state  estimate 


Note  that,  in  order  to  initiate  the  Kalman  recursion  formulas  of  Kquation  (2.20),  it  is  necessary  to 
establish  initial  conditions  for  x  and  p  i.e.  x,,  and  p,,.  These  initial  best  estimates  for  the  state  and 
its  variance  are  sometimes  difficult  to  determine  precisely  and,  so,  must  be  approximated  in  some 
manner  to  ‘start  off’  the  filter. 

2.2.2  (leneral  Form  of  the  Linear  Kalman  Filter 

The  general  form  of  the  lineiu’  Kalman  filter  for  the  multi-dimensional  situation  is  sinqily  an 
extension  of  the  foregoing  .scalar  case  using  matrix  formulation.  .\  general  nl'’-order  physical  (irocess 
is  assumed  to  have  the  following  sampled  data  version  of  the  plant  e(|uation: 


k 


k 


k 


X 


k  *  I 


e  t;  ^  •  u 


(2.21  ) 


whert' 


X  ^  iith.Qrdi.r  state  of  the  process  at  time  t,. ,  with  the  dimension  ( n  x  1 ) 

'!>  ;=  (n  X  n)  transition  matrix  representing  tin-  known  dynamics  t)f  the  process 

u  ^  mtli-order  ( m  ^  n  I  vt^'tor  representing  zero  mean,  random  distiirhanec's.  or  f)iant 
noise,  in  the  system  -  dimension  (m  x  1 ) 

Cl  =  (n  X  mi  matrix  ri“presetiling  the  effects  of  tlu>  m  noise*  .sources  on  the*  n  states  of  the 
system 


'I'he  plant  noise  vector,  o  ^  ,  is  usually  assumed  to  eorrt'spond  to  a  set  of  m  zero  mean,  random  noise 

proees.ses  with  constant  variances,  o’  ;  i  =  1 . m;  all  noise*  proe-esses  are*  assume*d  tei  be*  inili*pe*nd 

ent  of  each  oth(*r.  'rhe*se*  assumptieins  of  Ciaussian  noise-  result  in  an  (m  x  m)  covarianc  e*  matrix  for 
u  ,  of  the  following  form: 


o-,,  I  0  •  •  •  •  0 

0  e;-„_,  0  .  .  .  0 


y  ^ 


(2.22) 


•  •  0 

0  0  •  •  •  0  o- 


In  conjunction  with  this  gent*ral  mulli-dime*nsional  line*ar  plant,  assume  that  a  multi- 
dime*nsional  measurement  proee*ss  exists  as  follows: 


k  +  I 


H 


k  + 1 


:k  1 1 


-k  V 


k  e  I 


(2.2.!  I 


whe*re* 


y.  ,  .  t'fh-order  (V  n)  set  of  measurements  at  time  t,  ,  .  ,  with  the  elime*nsion  (V  x  1  ) 


^  I  (t  X  n)  matrix  which  ope*rati*s  on  x  ,  i  to  repre*se*nt  the  ri'lationship  bi*twi>en  state 

variahle*s  and  mi*asure*me*nts 


V  ,  I  (t  xl)  me*asure*me'nt  noise*  ve*etor  repri*si*nting  ze*ro  me*an.  random  disturbances 


(i.e*.  obse*rvatie)n  noi.se*)  in  e*aeh  of  the*  me*asure*d  epiantitie*: 


Tho  measurement  noise  vector,  V|.^i ,  is  normally  assumed  to  he  a  set  of  V  zero  mean, 
random  noise  processes  having  constant  variances,  i  =  1,  ....  V  each  noise  process  is  also 

assumed  to  he  independent  of  the  others.  The  ( V  x  covariance  matrix,  K  |  ,  for  v^^ ,  i  then 
becomes. 


o-\  ,  0 

0  o '  ^  , 


0 


(2.211 


For  the  foregoing  multi-dimensional  process  and  measurement  I'onfiguration,  the  Kalman 
filter  task  is  to  compute  the  best  estimate  of  x^^ ,  X|, ,  and  the  l  ovariance  matrix  of  X|^ .  P  .  at  each 

time  t^. ;  k  =  1 , 2 . .Vs  in  the  .scalar  case,  define  xj.  ^  |  as  the  state  update  leased  on  x  ( i.e. 

^  k  +  1  “  1’  k  ’  *’  define  P  J,  ^  i  I'ovariance  matrix  a.ssociated  with  \  ^ ,  .  The  general 

form  for  the  Kalman  update  of  X|^  and  P  ^  (proof  given  in  Kef.  4)  is  then. 


!ik^l  = 

i^k 

plant  update 

= 

■ 

Pk  *  2k  • 

’2i! 

covariance  of  update 

II 

+ 

^il 

•Hl!e,  -[Uke, 

•p;.,  + 

I 

Kalman  gain  matrix 

^k.i 

-  Vk.)] 

optimal  state  estimate 
after  k+1  samples 

Pk.l  = 

p;.i 

^k  +  1  '  2k-H 

'  p ' 

k  +  1 

covariance  of  optimal 
state  estimate 

(2.25) 


Note  the  strong  similarity  between  the  scalar  form  of  the  u|xlaU*,  given  in  Kquation  (2.20),  ami  the 
above'  matrix  form.  The  matrix  recursion  formula  given  in  Kquation  (2.25)  corresponds  to  a  mini¬ 
mization  of  P  ^  I  at  each  step,  i.e.  the  optimal  state  estimate  is  always  the  one  having  minimum  error 
variance  in  the  Kalman  filter  approach  to  the  problem. 


Now  the  Kalman  filter  update  equations  define  a  set  of  recursion  relationships,  readily 
implemented  on  a  digital  computer,  for  computing  the  optimal  state  estimate  of  a  physical  proci'ss 
in  real  time  this  is  the  essence  of  the  benefit  to  be  derived  from  a  Kalman  filter.  Assuming  that  the 


w 
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plant  and  nieasiircnuMit  proi  t-sses  arc  well-known  aei-urate  knowledge  of  <l>  ,  (1 .  II  ,  and 

R  )  tliiMi  all  that  is  required  to  get  the  Kalman  filter  sUirUil  is  knowledge  of  the  initial  state  vector 

estimate,  x  ,  and  its  initial,  or  so-called  a  jiriori,  covariaiu  e,  P  .  Often  it  is  difficult  to  specify  an  aci  u- 

rate  estimate  of  1’  it  really  reflei  ts  the  po,ssibl«“  variance  of  the-  error  m  the  initial  state  estimate. 

The  covariance  matrix,  l’|^,  is  quite  important  because  its  diagonal  I’lements  are  a  measure  of  the 

error  variance  of  the  individual  optimal  state  estimab's  as  a  function  of  time.  Usually  the  estimation 
error  of  each  state  is  reduced  dramatiially  during  the  first  part  of  a  Kalman  filter  run  and  then, 
eventually,  a  steady  state  error  condition  is  reached.  In  the  steady  state  region,  the  elements  of  both 
the  Kalman  gain  matrix,  K  ,  and  the  covariance  matrix,  P  j, ,  become  small  and  ni'ar-constant. 


2,3  A  C^uasi-I, inear  .Approach  for  Nonlinear  Systems 

.Many  practical  |)roblems  for  which  a  Kalman  filter  approach  would  be  ipiite  useful  involve 
nonlinear  plant  equations  and;or  nonlinear  measurement  e<iuations.  In  most  cases,  it  would  be  loo 
inaccurate  to  lineari/.e  the  ecpiations  compleU'ly.  so  somi-  (luasi-linetir  approach  must  be  found. 
Krii-dland  and  Bernstein  |  Kef.  7  i  anil  Kichman  and  H'rii'dland  t  Ref.  Ki  have  suggivsted  one  ap[iro'.,i’.'aic 
qutisi-lineiu'  technique  which  will  be  outlined  here;  there  are  also  other  possible  i  xlciisions  ol  tin 
Kalman  filti'r  to  include  nonlinearities  I  see  Ref.  3.  Cli.  S). 

.Maintaining  the  same  notation  as  in  Subsection  2.2.2.  ilefinc  a  nonlinear  sampled  d.iia 
plant  equation. 


'k-i  ■  ^  ‘-k  •  ‘'k 


so  that,  in  general,  an  ( n  x  1 1  vector,  f  ,  with  elements  consisting  of  nonlinear  functions  of  the  stale. 
X  .  replaces  the  linear  vector  functii'ii,  ‘1’  •  x  |^  •  of  Kipiation  I  2.21  ).  In  sinnlar  •as'; ion,  a  nonlinear 

observation  eiiuation. 


Vk.i  'X'k.i  '  "  ^'k.i 


Is  assumed ,  where  the  ( t  x  1  I  vector,  h  ,  has  elements  consist ing  of  nonlinear  functions  of  x :  and  h 

replaces  II  ,  I  ■  •v  ^  ,  I  of  Kquation  I  2.231.  The  noise  process  vectors,  U|^  and  V|^ .  are  assumed  to  have 
the  same  general  statistn  s  as  those  defined  in  Subsection  2.2.2. 

Consider  now  a  ipiasi  linear  state  transition  matrix.  'I*  .  whose  elements  are  defined  as. 


dfll  X  ) 


.  1  1 . n;  j  1 . n 


I 


-  10  - 


and  a  quasi-linoar  ohsorvation  matrix,  II  ,  havinf;  the  elements. 


[U.] 


()hi(x| 

(■)xj 


;i=l,...,t!;  j  =  l,...,n 


(2.29) 


The  Kalman  filter  update  (“((uations  for  the  quasi-linear  best  estimate,  x^^ ,  lh(“n  become. 


x',|  -  flx^^l 


nonlinear  plant  update 


k  +  1 


'K 


+  ( i 


covariance  of  update,  or 
a  priori  covariance  of 
state  estimate 


K 


k  t  I 


•  1’  '  •  II  '  +  R 

k  .  I  '  k  •  I  k  «  I  '  -  k  *  I J 


‘  K  •  I  k  M  ‘  ^ 


‘'•^k.l'  Vk.l] 


quasi-linear  Kalman 
sain 


optimal  (piasi-linear 
state  estimaU’  after 
k  +  1  samples 


I’ 


k  •  1 


k  .  I 


k  •  I 


i-ovanance  of  (jpt iinal 
state  e>t imate,  or  a 
posteriori  covariance 


Note  iliat  the  quasi  linear  approximation'  an'  used  only  to  c  alculate  the  Kalman  pain  matrix  ami  llie 
\arioii'  I  ovarianee  maira C'  I  he  true  nonlinear  relationship'  are  'till  used  for  derimiip  the  plant 
update,  X  ,  and  Ilie  IheorelK  al  oh'cia  at  ion  viTlor.  h. 

2.  I  I’ractictil  .\spects  of  I it'sipnmt'  and  Kunninp  a  Kalman  Kilter 

He  fore  a  prc'cntat  Ion  of  the  qmi'i  lim-.ir  Kalman  filter  a  Ipori  tli  m  dc'ipned  lor  the  I  top  pier 
!.K  tiavipal  ton  task .  a  few  ueneral  comment'  i  an  be  made  about  the  pract u  nlit  les  iin  ol  \  ed  m  mi) ili' 
ineittmp  a  Kaltnaii  filter  \  more  di'tailed  look  al  the  praelti  al  a'peets  of  Kalman  filternm  i'  rc'erxed 
for  the  later  i  haplers  on  the  Doppler  \  l,K  navipalion  filter. 

2.  I  1  System  and  Statistical  Modelling 

I  he  followmp  are  some  of  the  prai  tu  al  l  onsideralioii'  that  have  to  bi'  confronted  when 
modellinp  for  anv  Kalman  fdter  ap|iltcation 

II  <  tim  inii't  define  t  he  es'eiit  lal  'late  V ar tables  that  are  reqtured  to  desi  ribc  the  proi  i" 

adequately.  Iiicliidmc  additional  variables  that  define  ob'iaire  '"conil  order  cite,  t'  iwith 
an  a"0(  lated  increase  m  the  number  of  stales  beinp  eslimatedi  can  actuallv  cause  dilfi 
1  iilties  ihr  coin) iiitat lonal  bunleii  per  filli-r  cyide  could  become  excessive,  .and  theri  i- 
a  very  pood  i  liamc  that  liiu  ar  ilependent  le-  could  oi « air  ainonc  certain  staii-  varialile  .. 
resiiltmp  III  poor  state  estimation  overall 
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ii)  Bias  staU*  oslimation  tan  lie  quite  important  and  can  Be  implemcMited  quite  rc'adily.  Assume 
an  arliitrary  variable,  v,  of  a  physical  process  has  a  bias  which  is  to  be  estimated.  A  so-called 
bias  state  variable,  ,  can  be  defined;  and  the  correspond  ins;  state  update  equation  for  B, 
would  be:  B^ ,  =  B^  ,  with  no  plant  noise  assumed.  Several  such  bias  state  (‘(juations 
I'ould  be  included  as  part  of  the  overall  plant  e(|uation,  and  otUimal  estimation  of  the 
assumed  biases  would  take  place. 

iiil  Modelling;  the  statistical  characteristics  of  the  various  noise  proce.sses  accurately  is  e.ssi'iUial 
for  proper  operation  of  any  Kalman  filter.  Kven  the  basic  assumption  of  constant  variance, 
zero  mean  noise  proces.ses  is  suspect  at  time.  For  example,  a  correlated  noise  [iroi  i'ss 
modt'lling  might  be  desirable  and  certainly  could  be  implenn'nti'd  if  requiri'd.  Statistical 
nU)deliingof  tlu‘  measurement  noise  {)roce.sse.s  is  fairly  straightforward ,  sina'  one  usually 
has  direct  access  to  the  basit'  measurement  errors.  However,  correct  modelling  of  plant  noise 
processes  can  be  more  of  a  fine  art  than  a  science.  It  is  often  difficult  to  gain  aci  ess  to  ihe 
basic  error  quantities  that  corri'spond  to  the  plant  noise  as  defined  in  the  |)lant  equation. 
Sometimes  the  basic  error  proce-sses  of  the  physical  .system,  for  which  statistical  information 
is  known,  are  mollified  significantly  to  get  them  into  the  configuration  prescribi'd  by 
Fquation  (‘2.2t)).  The  main  concern  is  to  arrive  at  .some  ‘ball  park'  figure  for  plant  noise 
variance  which  in  some  way  reflects  the  randomiu'ss  that  can  be  expecied  in  the  chosen 
mathematical  de.scription  of  the  dynamics  of  the*  physii  al  process. 

iv)  Proper  initialization  of  tlu'  Kalman  filter  is  also  (|uite  important  in  order  to  have  accurate 
filter  estimates  as  soon  as  [lossible  after  filtering  action  begins.  .\s  already  mentioned  in 
Subsection  2.2.2,  to  initialize  the  Kalman  filu-r  one  must  specify  an  initial  stale  estimate. 

,  and  its  corresponding  a  [iriori  covariance  matrix.  P  •  P  ,  is  simply  a  diagonal  matrix 

consisting  of  the  various  individual  initial  state  error  variances,  u'  ^ 1 . n.  It  is 

not  so  important  that  x  ^  be  perfectly  ai-curate  what  is  important  is  that  P  eorreeilv 
rt'fleets  the  expevied  uiieertiiiiKy  of  (lie  iiiilividual  eleriieni.s  of  \  In  other  words.  P 
’tells'  the  filter  how  much  weight  to  pitiee  (.m  the  update  of  the  initial  state  estimate 
relative  to  the  ineoming  measurement  informiUion.  If  P  does  not  represent  the  true 
situation,  then  the  filter  state  estimates  will  not  be  as  accurate  ;is  they  could  lie  also, 
the  filter  might  lake  more  time  to  stabilize  lo  its  stetide  sttiti'  estimation  eonditinii. 

\ )  t  he  Kalman  filler  configuration  is  such  that  it  can  handle  various  eontiiigeni  ie-  1 1  .v  -  ..ddrn 
changes  in  the  (piality  of  the  datai  through  movlifli  atioiis  to  .  K  ^  .  or  even  I’ ,  .  In  i;h>.e 
advantage  of  this  capability,  one  must  have  einitinuous.  real  time  knowledge  of  tie 
eharaeteristics  of  the  various  .sensors  involved.  It  may  lake  a  great  deal  of  inuenuiiy  and 
forethought  to  devise  appropriate  monitoring  schemes  for  the  data  transducers.  I  h  'ue\oi . 
the  effort  would  reap  dividends  by  kei'ping  the  Kalman  filter  'optimally  timed'  throiiLin 
refreshing  it  with  the  lies!  statistical  information  availabli-  .it  any  point  m  time. 

2.1.2  Numerical  .Xccuracy  and  Stability 

One  im(iorlant  consideration  that  must  be  .iddressed  whi'it  inqileinenting  anv  K.'dm.ni  f.ltei 
III  a  digital  eom|niter  is  the  numerieal  accuracy  of  the  compulations.  .\ny  potential  aei  iiraey  problem 
bcsdines  more  acute  as  the  number  of  [ihysieal  slates  to  be  estimated  increases.  Basieallv  .  the  souree 
of  the  difficulty  Is  the  requirement  to  propauate  the  P  matrix  ae-  uratel y  1  v  la  the  mal rix  opeial  loio 
defined  ill  Kipiat  Ions  (  2.2.")  I  or  (  2.. 'Id )  I  as  I  lie  elements  of  P  deereasi'  to  v  cry  small  v  allies  u  it  h  Inin 
Nuini'rieal  analy  sts  liave  found  various  way's  to  combat  Ihe  problem  by  redi  l'inmg  the  iqidate  i  iii,:i 
lion,  m  a  nnmerieally  more  effieieiii  manner  1  vvo  pos.sible  approaches  rei  ei\  ing  a  lot  of  attention  m 
t  hi'  literal  lire  are  .qiitire  root  filtering  i  Kefs.  !i  to  1  1  i  and  I  ’  1 )  faeiori/.n  ion  i  Kefs  1 .1  n  i  1  1 1  1  hesi 

p.irt  leuiar  I  eehniques.  eoiiqiared  to  Ihe  m  il'inal  Kalman  n|)date,  are  ei  pnv  .ik  nl  to  doubling  the  'a  on  i 
li'iiglh  iisi’d  in  any  given  I'ompuler  resulting  in  an  oovious  mqirovi'ineni  in  nuinern  ,il  .n  .  ui.,.  \ 

Ihi'  I'oinpiit.ilional  effort  mvoKed  m  ihesi-  more  adv.ineed  numi'inal  techniques  is  sonewii.i) 
great!  r.  Ill  It  Is  demolist  rati'd  I  o  In  ■  \m  II  w  on  h  wlnh  in  a  high  dmnmsion  K  .ilman  1  iP  la'  s|i  mil  loi  i 
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Closely  associated  with  the  numerical  accuracy  problem  is  the  basic  stability  of  the  Kalman 
filter.  Undc'r  certain  circumstances  it  has  been  shown  that  a  Kalman  filter  can  be  unstable  the  state 
estimation  errors  actually  diverge  with  time.  .Many  times,  this  instability  is  associated  with  ill- 
comlitioning  inherent  in  the  problem  and  aggravated  by  the  numerical  inaccuracy  of  the  ordinary 
Kalman  update  equations.  Two  solutions  to  this  problem  that  are  commonly  used  are  the  following: 

i)  In  the  statistical  modelling,  include  a  suffu'ient  Icwel  of  plant  noise  to  imsure  that  the  co- 
variance  matri.x,  P  ,  never  gets  so  small  that  it  causes  a  numeriial  instability  problem  (which 
would  show  up  as  one  or  mon*  negative  eigenvalues  in  P  at  some  sampk-  timel.  Sometimes 
plant  noise  is  included,  even  with  a  very  accurate  plant  u|)date  equation,  for  this  very 
purpo.se. 

ii)  Use  alternatives  to  the  Kalman  U(Klate  equations,  su'  h  as  square  root  filtering  or  U-l) 
factorization,  which  tend  to  propagate  a  more  ai'ciirati*  P  that  remains  positive  definite 
(i.e.  positive  eigenvalues)  and,  hence,  circumvi-nts  the  stability  problem. 


;{.()  .\  i)Oppit:r/vlf  kalman  Kii;rKii  navigator 

Based  on  tlie  cjuasi-liiiear  tei'hniiiue  di-scribed  in  Si'ction  a  Kalman  filter  is  designed  lor 
o|)tinial  blending  of  Doppler  radar.  eoni|)ass  bearling.  .ind  VI,I''  station  phase  differenee  information, 
with  an  update  rate  of  otua'  every  ten  seconds.  The  primary  out|)uts  of  the  Kalman  filter  navigator 
will  be  the  o|)timal  estimates  of  aircraft  position  and  velocity.  The  mathi'inatical  modelling  is  devel- 
opt'd  for  the  navigation  eciuipment  presently  onboard  the  .\AK  Convair  580  research  aircraft,  with  the 
basic  navigation  paramett  rs  sampled  and  processed  using  an  Interdata  7  .'12  minicomputer  onboard. 
The  digitizetl  data  is  presently  stored  on  magnetic  ta|)e  for  post  flight  analysis;  but.  eventuall.v.  it  is 
intended  that  the  Kalman  filter  would  run  in  real-time  onboard  the  Convair.  using  thi'  Inierdala 
l  omputer  (.st'(>  Refs.  ] .  2  for  eomputing  cafiabilities  onboard  the  Coinairi. 

;j.l  Description  of  the  Basic  Navigation  I'ransducers 

I'lie  following  navigation  transducers  are  included  in  the  prt'seiu  design  of  the  Kalman  filter 

navigator. 

il  Dei'ea  l)op|)ler  Kadiu  a  three  bc'am  Doppler  radar  mc'asures  the  three  eomponents  of 
aircraft  veloi-ity  relative  to  aircraft-fixed  axes.  The  raw  RF  beam  freipieney  information 
Is  sampled  every  half  .secon<i.  In  order  to  resolve  aircraft-fixed  velocities  into  'straight  and 
level'  earth  fixi'd  com|Kments  (reipiired  for  navigation),  the  angular  attitudes  of  the  aircraft, 
pitch  (d)and  roll  (01.  are  also  measured.  .Appendix  .A  gives  a  lomiilete  description  of  the 
mathematics  involved  in  converting  the  beam  fre(|uency  ilata  into  the  more  ty|iieal  Dofipler 
grmmdspeed  (\'|,,,  |,  I  and  drift  angle  (n|  ()uanlities  (hat  are  reipiired. 

Ill  .Sfii  rry  C  12  Magm-tie  ('ompas.->  a  dual  compass  heading  system  onboard  the  Convair 
measures  magnetic  heading.  0.  v.  hieh  is  sampled  at  a  rate  of  twice  per  second.  I  he  true 
heading  wiili  respect  lo  geographic  north.  is  ihen  i-ompuled  as  ,i  0  \'.\K.  where  \'.\H 

Is  (he  magneiie  variaiion  for  the  given  geografihieal  area. 

ml  (ilobal  Nav  igaiion  C.N.S  200  VbK  Heeeivi'r  ibis  VI, F  receiver  is  ii.sed  in  i  imjunetion  with  a 
Bh  fri'ipienev  siandard  onboard  the  Convair  to  measure  the  phase  difference  between  the 
I ransmissions  Irom  (he  viirious  r..S.  ,\avy  Coinmunieations  stations  and  the  Kb  eloi  k  I  lu'se 
phase  stable  measurements  can  be  directly  relali'<l  to  the  dislaiu  es  from  the  airi  raft  to  each 
of  the  V  LF  si  at  ions  the  pha.se  measuremi'iits  for  all  sUitions  are  sampled  simultaneously 
every  ten  seconds.  .Alipendix  B  is  a  table  listing  the  essential  fciitures  of  each  of  the  \'l,l' 

( 'om  mu  meat  lolls  st  at  ions  that  can  be  ri'eeived  bv  I  he  ( 'onvair's  (  bNS  200  unit .  for  more 
I  let  ails  about  the  operat  ion  of  the  ( IN.S  200.  and  V1,F  nav  igat  ion  m  general,  see  Kefereiiees 
I  5  and  1  li 


3.2  Mathematical  Development  for  the  Kalman  Filter  Navigator 

The  basic  task  is  to  design  a  mathematical  algorithm,  suitable  for  use  in  a  eompuU'r,  which 
blends  together  the  Doppler  radar,  heading,  and  VLF  information  in  an  optimal  fasliion,  along  the 
lines  of  the  quasi-linear  Kalman  filter  approach  described  in  Section  2.3.  Figure  1  is  a  very  simple 
block  diagram  representation  of  what  the  proposed  navigator  would  do.  Kach  of  the  basic  navigation 
inputs  shown  in  Figure  1  is  assumed  to  be  corruptt“d  with  bias  errors  and  noise  the  job  of  the 
Doppler/ VLF  navigator  is  to  compute  the  best  estimates  (in  the  minimum  variance  sense)  of  position 
and  velocity  based  on  this  imperfect  data.  The  specifications  defining  the  proposed  Uoppler/VLF 
Kalman  filter  implementation  are  categorized  as  follows: 

i)  Raw  Navigation  Parameters  -  the  following  parameters  com|)rise  the  set  of  injiuts,  either 

measured  or  calculated,  that  the  Kalman  navigation  filtr'r  will  use: 

f|,  f|, ,  f^,  RF  beam  frequencies  of  the  Dopjiler  radar,  measured  in 

hertz  (hz). 

d,0  —  aircraft  pitch  and  roll  attitude  resiiectively,  measured  in 

radians  (rad). 

—  Doppler-derived  groundspeed  (from  Aiipendix  .-\)  measured 
in  nautical  miles  per  second  (nm/sec;  conv(>rted  from  knots). 

cv  —  Doppler-derived  drift  angle  (from  Appendi.v  A)  measured 

in  radians. 

0  —  magnetic  heading  from  C-12  compass,  measured  in  radians 

(converted  from  degrees). 

P  —  true  heading.  i//-VAR,  in  radians. 

cv  +  (3  true  track  angle  of  aricraft,  in  radians. 

0i,  i  =  1 . b  VLF  station  phase  difference  between  station  i  and  Rb 

clock,  a  total  of  six  stations  assumed,  mi’asured  in  micro¬ 
seconds  (ju  .see:  0i  is  actually  the  time  it  takt's  for  the  VLF 
signal  to  travel  from  station  i  to  the  aircraft;  d  =  ct  inqilii's 
that  one  p  .sec  is  equivalent  to  a  distance  of  0.162  nm). 

ii)  Biases  Assumed  -  for  modelling  purjioses,  the  following  bia.ses  are  assumed  to  exist  in  the 

navigation  peirameters; 

By  ^  bias  in  grounds|)eed.  V|,,j,,  (nm/.sec),  assumed  to  originate 

with  th«“  biases  in  f  , ,  f,,,  f^^.  and  possibly  0,  0. 

B^,  bias  in  drift  angle,  o  (rad),  assumed  to  originate  with  biasi's 

in  f,|,  f,, ,  f^.  and  possibly  0.  0. 

B^'  liias  in  true  heading,  p  (rad);  a  combination  of  any  bias  in 

measurement  of  0  plus  a  |X)s.sil)le  bias  in  the  spei  ification 
of  variation,  VAR. 

B,,^  the  combination  B_,  +  B^,,  i.e.  bias  in  true  track,  ii  +  p  (rad), 

i  =  1,  ....  6  -  bias  in  the  phase  difference  measurement  of  station  i  (p  sec). 


Ill)  Noisi'  I’roc'i'ssi's  Assiinu'd  i1h‘  iiifasurc'd  and  rompulod  paranii'lc'rs  arc  assumed  to  have 

the  following  /.ero  mi'an,  eonslanl  variani'c  noise  processes: 

11^  random  noise  in  the  measurement  of  witli  variance 

Oy  "’inm"  /see’ ). 

u  random  noise  in  tlu‘  measurement  of  o.  with  vanaiu  i' 

u  -  (rad-  ). 

u  random  noise  in  the  measurement  of  p.  with  wiriance 

u  '  (rad' ). 

u^  eombinalion  of  noise  proeesses.  ii  +  u  ,  with  varianc  e 

u  "  o  ’  +  u  ’  ( rad  -  i . 

V  .  i  =  1 . (i  random  noise  in  the  measureiiK-ni  of  (,vi,  vMth  \ariaiic  t' 

a  {/J  see-  ). 


Doppler  Note:  the  l)op|)ler  liiasits  and  noise  proeesses  l  ould  have  beim  defined  in  term^  of 
the  beam  frequencies  (i.e.  f,.  f,, ,  1\  )  and  possible  Itiases  |)lus  random  noist'  in  their  measure¬ 
ment;  however,  it  was  felt  that  this  proei'diire  would  be  unduly  eomplieatetl.  Computer 
simulation  has  demonstratt'd  that  the  simpler  error  modelling  defini'd  above  is  perfectl.v 
adequate  for  the  types  of  aircraft  trajectory  ex|H>et(‘d  (i.iu  mostly  near-constant  velocity 
straight  line  or,  possiiily,  shallow  curved  tracks). 

(iv)  Digital  Sampling  Rates  -  there  are  two  basic  rates  of  sampling  the  inc  oming  na\igaiicm 
data:  every  half  second  on  the  Dopitler/lu'ading  data  aiul  every  tern  sc'conds  on  the  \ 

[ihase  difference  information, 

(V)  Process  and  State  Variahk's  Chosen  —  thi'  pliysical  |)roci'ss  assumc'd  for  the  (luasi-liiic'ar 
Kalman  filter  is  the  Do|)pler  equation  for  updating  geo)tra|)hical  iiosition  encry  ten  seconds 
ba.s<>d  on  inU’grating  Dopjiler  velocity  com|H)nents  over  that  period  of  time.  vector  set  of 
ten  discri'te  state  variatiles,  .x,  is  defined  as  follows: 


PL. AT 

Xl 

geographical  latitude  of  aircraft  (di‘g). 

PLONC.  - 

x2 

geographical  longitude  of  aircraft  (deg). 

xli 

bias  m  l)o|)()ler  groundspeed  (nm  sc'c). 

R 

xl 

bias  in  (rui*  track  (rad). 

'^.1 

x.u 

bias  in  measurement  of  station  1  phase'  (p  sec) 

B  , 

x() 

bias  in  measurement  of  station  2  phase  (p  sec  ) 

B  . 

x7 

bias  in  measurement  of  station  .'i  phase  (p  sec  ) 

xH 

Inas  m  measurement  of  station  1  pliase  (p  seci 

x‘t 

liias  in  measurement  of  station  .')  I'liase  Ip  see  ) 

c 

nIO 

Inas  in  measurement  of  stalion  d  phase  ip  seri 
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vi) 


StaU'  K(juations  of  the  Dynamic  Process  -  recall  that  the  discri-te  form  of  the  dynamu 
process  is  the  vector  difference  equation. 


""km  =  ^  •  ''k 


Ci.l 


I 


According  to  the  state  variables  and  process  chosen,  the  elements  of  f  will  he  as  folluw- 
(see  Appendix  ('  for  more  details): 


fl(Xk) 


PLA'l'k  +  [a1,  -  All,  •  J  •  s 


ml  B  ^  I 


[■^^2,  -  Al,  -B.  J  •  cos(B,,^, 


^  A.\  -xdj 


smixl,  I 


+  [a2,  -  A  l^  •  xdj  •  cos(x4, 


f2(x,^) 


[Aik-  Ad,  -Bvk] 

PLONG^  -  — - —  _ 

cos  [PLAT^^  •  Tr'lBo] 

_  [a4,  >  B,.,  -  A2j 
cos[PLA’l\  •  7r/180] 


cos(  B 


sini  B^^  I 


=  x2,  - 


K 

^  cos[xl^  •  ,T/l«o] 


cos(  \  1|^  I 


1.1,21 


[a1,  -  .xd,  ..\2j 

cos  [x  1 •  ,T  1  ,SoJ 


sin(  x  l|^  ) 


fd(  \  I 


k  ^'^k 


fllx  ^  ) 


'^.k  ^'k 


. nnix^)  B  . B,„^  x5^ . Xlo^ 


1 

(iO 


+10 


•  siii(c»  +  j3)(lt 


A1 


k 


V 


I)  ()  I’ 


1 

00 


k  +  10 

j'  ^'do  r  ■ 


A.i 


k 


1 

(SO 


10 


hinio  +  ^3)clt 


( .i  .'i 


A  I 


k 


1 

()0 


‘k  " 

I  +  p'idt 


rill'  iiUt'tiralioiis  r»'(|uiri‘d  in  I'kiualion  (d.di  arc  coinjuitiai  diiriOilly  usiny  irapc/.oidal  inic- 
^'ration  (  Kid',  17)  on  tlic  20  samples  o!  Doppler  heading  ilala  that  oeeiir  in  each  ten  .'ceond 
update  intenal. 

Plant  Noise  I’roeesses  .Appendix  ('  shows  the  details  of  how  plant  noise  can  he  modelled 
;ts  a  fiinetion  of  the  onttinal  [)op|)ler  noise  prola•s.■^e^  n^  ■ 
element  vector. 


w  lieri' 


\  k 


‘k  ^  1'^ 

f  n^  dt 


u  * 


,'k 


'k  ^ 

j  ( u  +  u  )dt 


la 


1  he  noiNC  proees.ses,  u  '  ^  and  u  '  .  are  assumed  to  he  zero  mean,  constant  variance  ranilom 

noise  with  variances  a  -  ^  ’  and  n*  *  resfieci ivelv  once  a^ain.  the  integrations  are  aecom 
plished  diititally  via  trape/.oidal  inteitration.  The  auto  l■ovanalu■e  matrix  associated  with  n^  , 

.  is  identified  as  the  I  2  ■  2)  matrix. 
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r 


Q 


( .’i..')  I 


Also,  from  Appondix  Kcpiation  ((’15)).  llu’  (’>  matrix  is  sliowii  to  lie  the  ( 10  /  2) 

matrix. 


IK  - 


r 


In  tlii>  rase,  the  nu’asurciiu'nl  vcclur,  \  .  will  roiisisl  of  llin  si\  \'1,F  phase  (liflcrmc  i' 
ri'adinas: 


riic  six  elements  ofh  are  idenlifieii  as  follows: 


hlix^^l  dpi  ( I’l^.A  I  dpi  ( \1|^ .  x2.  I  xh 


h2(x^)  dp^d'LAlY.  IM.O.NG^  )  +  H  ,  dp2|xl^.  x2^i  +  xii^ 


l.hlDl 


hiKxj  dphlPLAI^.  I’LOXGi^  )  +  K  dpd(  x  1 .  x2|_^  i  +  xKI^^ 


where  (.Ipi :  i  =  1 . (i  repri'Sc'iUs  iho  theoia'lieal  phase  chfferenee  I  measured  m  p  seel  I'or 

suit  ion  i  al  the  aeo^Taphieal  loeation  ( I’LA'l'.  I’IdJNC.  i.  The  relationship  expressed  I  ly  ilp 
IS  not  I'xplieit  rather,  it  is  emboilieil  m  a  eompnter  altrorithm  known  as  the  Sodano  iiuei'si' 
routine  (Kefs.  IS.  Idi  which  must  hi'  mcluiled  as  p;u't  of  the  Ixalman  filter  alttonthm. 

ixi  Observation  Noise  I’roeessi's  the  measun  menl  noi.se  is  modelled  as  ihe  six-eleineni  \eeior. 


'  k  ['■  1  k  '  .  :k  ■  ■  .'k  ] 


1 1 


havinfjan  assoeiateil  ( (i  s  (Ji  auto  covariance  mairix. 


o-  I  0  0 


0  n-  , 


K 


i:M2i 


0  ()••••  n 


I 


19  - 


(X)  (.Juasi  L\iM‘;ir  Stall*  Iraiisition  Matrix,  <1*  -  roi-all,  from  Kquation  (2.28),  that  Ihi*  (“IcmciiU 
of  >1'  will  bi*  cii*fiiu“<J  a.s. 


(■)fi(x) 

('iX] 


;  i  =  1 . 10;  j  =  1, 


10 


(8.1 3 1 


from  tin*  dofinitioii  of  Ihi*  fi’s  given  in  Kquation  (8.2),  ‘I'j^  can  be  identified  a.s  tlie 
(10  X  10)  niatrix, 


1 


where 


0 

0 


0  afl/(')x8|^  dfl/dxl^  0 


8f2/8xlj^  1  (■)f2/ax8^  ;)f2/<')xl^  0 


0 

1 


0 

0 

0 

0 


1  0 
0  1 


(8.1  1 1 


aci  :is8, 


.\8^  •  siiK  \  1  ■  '■»>><  X  1^^  I 


an  <'ix  1^  (.\l^  .\8|^  •  x3,  I  •  eos(xlj^)  -  ( .\2^  -  Alj_  •  x3j^  »  •  sin(xlj^i 


ar2  axi, 


[(.\1,  -  .\8^  •  X3^)  •  e<)s(x  l^)  +  (A\  •  x3,  -  A2,  )  •  sm(x!,l] 


Tt  sin(xl^  •  n./180) 


ISO  ■  eosAxl^  •  ,7.180) 


( .8. 1  r>) 


af2;ax8, 


[.\8^  -eoslx  l^)  Al^  -  .sinlx  l^)]  • 


eos(  X 1  ’7  1  SO  I 


af2  ax  I,  [(Al^  .\8,  •  x3^  »  •  .snKx.l^  I  (A  1^  •  x8^  •  A2^  )  •  eosix  1^  l] 


l'()S(  X  1  ’71  1  SO) 


■  1th  .\1^  •  .\  1^  already  defined  in  Kquation  (8.8). 
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xi)  Quasi- l.inear  Observation  Matrix,  H  based  on  Ktiuation  (2.29),  the  elc'inents  of  1 1  will 
be  defined  as 


()hi(x) 


;  i  1 _ 0;  j  =  1 . 10 

'k 


Ci.Kil 


From  the  definition  of  the  hi's  ftiven  in  Kqualions  (2.10).  H  can  be  identified  as  the 
((>  X  10)  matrix. 


(■)d(jil/0xlj^ 

i’)d01  /i)x2|^ 

0  0  1  0  • 

•  0 

9(102/(1x1 

<td02/(l.\2|^ 

0  0  0  1  0 

•  0 

«  •  •  •  • 

•  0 

()d0()/()xl|^ 

<)d0()/()x2|. 

()•••• 

0  1 

.\fi()<'n<li.\  1)  shows  details  of  the  e.xjdieit  eon)|)utat)on  of  f)arlial  derivatives  iHl0i  , 
(')ddi /()x2|^ ;  i  -  1 . ()  l)ased  on  outt>ut  information  from  the  Sodano  inv('rse  routine. 

xii)  Detailed  Hloek  Ditij^'am  Kc'presentation  the  iom|)lele  mathematieal  lievelopment  for  the 
propo.sed  Kiilman  filter  navijiator  has  b(>en  outlined  in  this  si-etion.  Kijturi'  2  shows  a  de- 
tiiiled  bloek  diattram  r('[)res<'ntation  of  the  l)o|)i)ler/\'LF  Kalman  filtc-r  navigation  seheme 
inilieatintt  the  individual  inputs  and  outputs  essentially  an  expansion  of  KitJure  1.  The 
following;  points  summarizt'  the  main  operating;  features  of  this  proposed  hybrid  naviftation 
algorithm: 

a)  Doppler  radar  ami  eompass  heading  information  ari'  used  by  the  Kalman  filter  to 
define  the  basie  plant  [iro<-ess  ( i.e.  to  r<>.solve  ami  integrate  I )op|>ler  \eloeity  eonpio 
nents  in  order  to  get  position  updati's). 

b|  \'1,F  station  pha.se  differem-e  information  becomes  the  so-called  measurement,  or 
observation,  process. 

c)  .\11  the  available  data  is  used  to  compute  optimum  estimates  of  position  every  ten 
seconds,  plus  calculate  the  various  Doiipler  heading  ami  \'I,F  biases. 

dl  rile  esi  imali's  <d' bias  III  Dofipler  grotmdspeed  ( )  ami  true  track  aintle  I  H  lean  be 
used  to  correct  \  I ,  I,  |,  and  o  *  p’  in  order  to  arrive  at  improved  velont \'  estimates. 

V  l,,\'l  and  V I ,( )N(  '■ . 

el  file  est  limit  es  of  bias  m  \'  LF  phase  (1$  i  can  be  used  to  correct  the  raw  \'  I.I-'  phase 
measurements  (  C'l  I.  result  mg  in  imiiroved  \'  l,F  phase  data,  Oi;  i  1 .  .  .  ti. 


1")  If  (‘ithor  Ihf  Dopplor/hcadinn  or  VLF  subsystems  Ijccomi'  moperalivc  (iurmt'  the 
navitjalion  task,  ttie  l>ias  errors  will  have  been  ujKlateti  by  the  Kalman  filter  to  that 
point  in  time.  This  should  mean  more  aei  urate  navinalion  m  the  dejtraded  modi' 
compared  to  no  estimation  of  biases  in  the  system. 


1.0  SlMUL.VnON  P:XPKR1MENTS  with  the  DOPPLKR/VEF  K.MAl.VN  FILTER 

I’he  important  features  of  a  eomfiuter  protn-am  usi-d  to  simulate  operation  of  the  Kalman 
naviftation  filter  are  given  in  Section  1.1.  Other  sections  in  this  chapti'r  are  dc\otcd  to  identifying, 
through  various  simulation  e.\periments,  tlie  rather  unique  I'haracteristics  of  the  proposed  Kalman 
filter  ilesign. 

1.1  Details  Concerning  the  Simulation  Algorithm 

.\  computer  program  for  simulating  the  running  of  the  l)o|)pler'VLF  Kalman  filter  in  real 
time  has  been  designed  and  written  in  the  FORTRAN  IV  programming  language  for  the  IBM  .'iOdH 
rSS  o|)erating  environment.  Figure  .i  is  a  block  diagram  repre.sentation  of  the  simulator  anil  Figure  1 
shows  the  as.sociated  computer  program  flowi  hart.  .Somi'  of  the  [icrtment  features  of  this  particular 
simulation  routine  are  the  following: 

Simulated  motion  of  the  aircraft  is  cither  a  straight-line  trajectory  with  constant  velocity, 
or  a  circular  track  with  constant  tangential  velocity:  velocity  and  track  spec  ificd  by  the 
user. 

The  Dopiiler  navigation  simulator  outputs  groundspeed.  heading,  and  lirift  angle  rather 
than  the  more  fundamental  Dojijiler  beam  fre(|uency  data  it  has  been  verified  that  the 
simpler  approach  used  is  sufficiently  acctiraU'  for  simulating  the  Doppler  radar  system. 

,\ny  level  of  liias  and/or  random  noise  can  be  simulated  for  the  Doppler  groundspeed. 
heading,  drift  angle,  and  VLF  station  phase  difference  measurements. 

riie  VLF  simulator  tises  a  version  of  the  Sodano  inverse  routine  to  compute  the  theoretical 
microsecond  jihase  readings  for  the  different  VLF  stations. 

.\  variable  number  of  VLF  stations  can  be  simulated;  u|)  to  a  maximum  lUimhiT  of  six. 

.\  plotting  routine  has  been  developeil  to  display  the  results  from  any  Kalman  filter  simu¬ 
lation  run.  This  routine  allows  a  great  deal  of  flexibility  with  respect  to  jilotting  interval, 
scaling,  and  desired  information  ti.e.  Lat/Long  position  estimation  errors.  Doppler  heading 
bias  estimation  errors.  VLF  bias  estimation  errors,  or  any  combination  I. 

The  simulation  routine  al.so  prints  out  the  Kalman  filter  state  estimates  and  the  1’ ,  *1'.  ( 1. 

K  matrices  every  ten  seconds,  mainly  for  debugging  pnriioses. 

.\  modified  version  of  the  simulation  routine  permits  the  use  of  real  navigation  data  stored 
on  magnetic  tape,  with  the  further  option  of  being  able  to  modify  the  data  to  simulate 
desired  data  conditions. 

The  modified  routine  al.so  has  options  for  various  VLF  contingency  checks  (to  be  ilescnbed 
in  Section  l.h). 

■L‘2  Transient  and  Steady  State  Nature  of  the  Kalman  Filter 


J 


One  of  the  first  characteristics  of  the  Doppler, /VLF  Kalman  filter  to  be  studied  in  some 
detail  via  simulation  was  the  speed-of-resjionse.  or  transient  nature,  of  the  filter  as  a  function  of  the 
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spot  ifiod  initial  conditions.  Of  particular  interest  was  the  nature  of  the  bias  estimation  rcspon.se  as  the 
diagonal  elements  of  the  initial  state  estimate  covariance  matrix,  I’  ,  were  varied  in  si/e.  For  this 
study,  a  straight-line,  constant  velocity  trajc'ctory'  was  simulated  for  the  aircraft  motion-<letails  of  the 
simulated  navipition  conditions  are  summarized  in  I'ahle  4.1.  .Note  that  larfti-  bias  errors  were  simu¬ 
lated  for  evc'ry  (piantity  of  interest  (i.e.  ttroundspeed,  true  track  angle,  and  six  V'LF  station  phase 
differetH'esl  in  order  to  resolve  the  transient  response  of  the  bias  estimate's  accurately. 


l  ABLK  4.1 


SIMULATED  NAVIOATION  CONDITIONS 


Trui'  start  position  (Lat/Longl 
Error  in  start  position  - 
True  groundspeed  ( ^  ) 

Bias  in  measurement  of  V|),j  |,  - 

True  track  (cv -1^ /3) 

Bias  in  mi'asurement  of  a  +  0 

VI.F  stations  -  O  O  .\1  .\  D  \V 

VLK  measuremc'iit  biasecs  -  10.0  10.0  10.0  10.0  10.0  10.0 

.Noise  variance  for  V|)  ^  ^ 

Noise  variance  for  a:  o’ 

Noi.sc'  variance'  for  0:  o’  ,  - 

Noi.se  variane'e's  for  VLF  stations:  o’  ,  (i  =  1 . (>) 


15.0/75.0  eleg 
0.001/0.001  deg 
250.0  knots 

10.0  kneits 

15.0  de'g 
10.0  d('g 


p  sec 

1 .0  knelt ■ 

0.25  de'g’ 

0.25  eleg- 
1  .0  p  se'c"  ;  all  l 


Recall  that,  in  oreli'r  tei  initialize'  the  Kalman  filti'r,  it  is  lU'ce'ssary  tei  specify  a  starling 
e'stimate'  eif  the'  state',  .  anil  the'  e  eirre'sponding  i-ovarianee'  matrix  of  that  estimate.  1’  .  l-eir  this 

partie  ular  simulation  stuily,  the'  initial  position  e'stimate's  had  an  I'rror  of  0.001  eli'g  in  I'aeh  of  latiimie 
anel  longitude'  while'  all  the'  initial  I'stimate's  eif  bias  wi're'  se'l  to  zi'ro.  Se'ts  eif  variane  i's  for  the'  imii.il 
e'stimate's  of  all  the'  state's  we're'  groupe'el  into  one'  of  thre'e'  e  ali'gorie's:  small,  me'elie  i,  eir  large'.  I  he  se' 
initial  e  einelitieins  feir  the'  traiisie'iit  re'sponsi'  study  are'  all  summari/.e'el  in  Table'  1.2. 

Figure's  5  to  7  sheiw  the'  se't  of  Kalman  filte'r  slate'  e'stimate'  rirors  as  a  fune  tion  eif  time'  fur 

the'  thre'e'  eliffe're'iit  initial  e'rreir  variaiie  e'  e  ate'gorie's.  .\  e  are'ful  leiok  ;it  the'se'  jiliits  re'Ve'als  that  the'  s| el 

eif-re's|ieinse'  (in  te'rrns  of  eli'e-re'asing  the'  initial  state-  e'rrorsi  me  re'a.se's  as  the'  initial  e'rreir  variaiu  e'  li m  Is 
me  re'ase'  ( freim  small,  tei  me'elium.  tei  large').  ( 'onve'rse'ly .  eini'  e  eiulii  say  that  the'  e'ffe'e  tn e'  elampmg  nf 
the'  filte'r  me  re'ase's  as  the'  initial  e'rror  vanane  i's  ili'i  ri'a.si'  in  si/i'.  For  the'  (lartie  ular  initial  e  rror  \:in 
anei's  e  heise'ii,  eine'  almost  has  a  situatiein  akin  to  an  ove'relampe'd  (initial  bias  vananei's  0.1  I.  e  rili 
i-ally  elam(ii'il  ( initial  bias  variane  i’s  5.0).  or  undi'rilam|ie'el  (init lal  bias  vanane  i's  1  00.0)  re  s) 'oiis. 

( )f  I'oursi',  the'  initial  I'rriir  variane  i's  shinilil  bi' i  ho.sen  on  the' ba.sis  of  a  prion  informal  ion  available 
I'oni'i'rning  possible'  I'rrnrs  in  tin'  initial  state"  I'stimati's.  The'  fori'ginng  analysis  siiipiK  ili  inonsi r.iie  ^ 
how  t  hi'  trails  II 'lit  ri's|iiinsi'  of  the'  t  ill  it  will  bi'  affi'iti'il  by  I  hi'  nut  lal  i-rn  ir  e  e  ivananei's  that  an-  ii-.i'i  1 
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TABLE  1.2 

kAl..\lAN  KII.  I  KR  INITIAL  (  ONIBTION.S  EOK  TRANSIKN  I  RK.SI'ON.'^K  SH  1)V 

I’osUlon :  f'l.AI  IM.O.Ni;  I,')  1)01  7.')  001  il.  y 


Mki.-- in  1  )()|i|ilcr  ^rouiulspccd  :  ,,  O  ()  kiuit 

Bia>  in  irun  trark :  M  0.0  ili  j: 

Hia.scs  in  \T,K  phase  iiifa.siiriMiicnt^:  11  ^  li  1.  ...til  0,0  p  ms;  all  i 


Noisr  varianrr  levels  ..aiiie  as  1  able  1 . 1 
Krror  eovarianee  inatri\,  1’ 


.'small 

Medium 

Larne 

N’ariaiu  e  id'  I’l.-M 

l‘  1  1 ,1  1 

0.00001 

0  001 

1  .0  deu 

\  arianee  (if  IM.(  )N(  I 

;  1',  i2.2i 

0  OOOOl 

0.001 

1  .0  deu 

X’arianee  id' 0^  I’ 

(d,:ii 

0.1 

.■>.() 

lOU  0  kill' 

V'.iriaiii  e  Ilf  H  1 

’  (I.n 

0  1 

.‘ll) 

1  nil.O  deu 

\'.iriani'e  ni  |i  p 

I  ,'i .  .'i  1 

•  1'  I  lO.lOi 

0  1 

.■l  II 

lOll  (1  ):  -e 

1  lie  re-  I  It  s  ( lepi(  le.  I  in  1'  iitni'e-  .‘i  to  7  iii.iKe  si  n  m-  ml  .lit  i  \  i’Iv  .  -m.  i  •  ,ii;  !  ■•  ii  u'  e  e  '  h.i' 
'peeifv  II  ,t;  a  \  el's  small  lull  lal  eri  nr  \  al'laili  i  ■  i  >rri  'p<  mi  1,  l .  1  l .  11  mi;  t  In  K.n  m.m  1 .  i  1 .  -  ;  l.e  •  ,i  i  i '  :  ' 

1  leal  .  if  emphasis  on  the  initial  -l  .it  e  e-t  imali-  .nul  it  -  npd.i  ii  ■  i  mip.tr  1  ; .  w  h.i:  .  i.  e  i :  1 1  ■  a  ’ .  .,il  a  ’  ;  i 

Ill' I  ml  mu  ,  iie.isiiri  i:..  ml  d.it  .1  III  mill  I  ii- hrminiit.  Ihu-  n,  p.ti  ii.  nl.n  ,  'he  l\.i,  in.m  M  l  e;  i-  -l.iv.  t.'i.,;  ; 

til  I  111  ■  lar.'i  initial  ert'  if'  id  tin  -  I  ii.is  i  ■  -t  imal  e-  <  )ii  On  ■  n  ler  h.i  in  1 .  ,i  l<ii  la-  ii  i  a  ;  i '  .  ri .  h  v  .ii  iiin  i  -pi  ■. 

In  .it  n  III  mi  piles  that  M-rv  1  il  l  le  weiapi  ,hi  mli  I  in  p.l  mi  tin  mit  i.tl  e-l  iin.ili  .  •  mi  i  mi  id  I . '  tie  m*  .i- 
iiremm  ii  dal.i  1  he  I'll  1 1  r  linn  ri  -.n  I'  ■  pimk  |  \  .  i  m  'he  I  i.i-is  .it  tin  iin  mil  mu  >l.il  .i ,  :  - '  i  a-i  1  ’  a  lie  i.n  .  . 
ill II  i.il  pi  isil  imi  I  ir  I iia  ■  erri  'i' . 

.\i  1  mi  I  mu  1 1 1  I'  iL'iire-  .7  I '  >  7 .  .i  sii-.idv  slat.-  -it  iial  imi  i-  i-v  i  nt  u  ili\  i  'M.  1  .ed  m  u  h  e  1 1  lie 
V .irim.s  en I  ir  i pi.inl  it  n  -  -i .il nli/e  at  i  elal  iv  el\  sm.il!  v ahie-  ,i  i  \  pn  al  re-pm ise  Inr  .i  K.ii  in.n ,  l  ilt ei 
I  siiall  V  ,  1 1  nr  mu  the  ri  mr  .e  i  d  .m\  K.ihiian  I'llter  run.  I  here  i-  an  mil  lal  i  r.m-ieiii  is  u  e  m  id  1 1  i.ii  i  \  i  . 

h  luin  T  d  .iti  ■  e  -  t  iin.il  n  III  eri'i  ir  .  a  -  I  In-  tilt  er  ,iH'-mpls  li  •  .ulapt  l.  >  tin-  iin  mn  a  lU  tial  .i  i  i  m  lie  I  m  i  -  i  d  tie 

assumed  iinnlel  .mil  mili.il  i  midilimi'l  In  time,  tin  .nl.ipt  ,il  imi  pli.isi-  e  .  ..inpleiid  a  -iiad\  tali 
I  III  e  III  iim  I  In  'll  |  in -vail'.  i  i  irresp.  nn  Imu  ti  i  minmmiii  i  i  Ti  ir  m  I  In'  sl.iii-  <•  ,i  im.iti  -  si  ml  y  mu  1  he  m.il  re  ■  - 
I'  .nul  K  a-  ruin  Inms  id  lime  i  .in  alsii  lie  iiistmetive  when  it  emiies  tti  iiinii  rs’.mdmu  the  uper.ilimi  id 

a  K.ilman  I  dler  I'  lenre  .  .s  1 1 1  1  O  shi  iw  K  K  '  and  I’  as  riiin  limis  i  d  t  line  I  m'  e.e  h  i  d  1 1  le  simill . 
iiiei  I  mm .  and  l.irue  I'  i  .i-es  .dre.id  v  eili'd  1 1  he  matrix  in  irni.  •  .  is  ih  I  nni  I  .i-  the  -i  p  i.iri  1 1  u  il  ijt  |  he 

-inn  id  the  -i  pi.ire-  1 1 1  I  he  I  li.iL'i  m.il  elennii  ts  i ,  I  he  I  ran  semi  respmise  n.it  i  ire  .  d  l  he-e  1 1  n.mt  il  le  1 .  d  li  iw  - 

the  s.mn  pal  I  ern  .i-  d  ii  I  tin  i  ,ii  e  est  nnali's  Inr  the  sann  i  aleitnrie  -  nl  I’  I  In  Kal  iii.m  u.ni  i  m.d  ri  \  .  K 
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iiMi  lu's  a  .'.mall,  steady  stiite  vakie  (as  mea.siireil  by  il  K  K  ’  ll(.  iiidiratiii^;  lluil  the  plaid  u))(lap'  prm cr" 

has  heinme  (|mte  aeeiirale  alter  all  the  biases  have  lieen  esliinaled  properly.  Ktirthermore.  the  eo 
variaiK  (■  matri\.  I’ .  also  ri'aelies  a  low  level  in  the  steady  state,  implyii.f,  di  d  the  state  estimati*  error 

\ariaiiees  have  bet  ome  ipiite  small  ;is  the  filter  adapts  to  tlie  meomiiiu  datti  ( i.e.  the  aeiairte  y  of  stale 
estimation  htis  improved  with  timei. 

l.;{  bias  Kstimatiiin  and  l.inetir  Dependency  l*r<iblems 

It  beeame  obvious  very  etirly  m  the  tmalysis  of  the  Doppli'r  VI. h  Kalman  filter  that  the 
bia.se.s  m  \  1 1 , 1 ,,  and  1 1  p.  li^  a  nil  If  respeet  ively .  eoiild  be  estimated  (|iiiekly  and  aeenralely ,  witli 
no  not leealile  mleraetion  between  the  two  Doppler,  heading  biases  be m^  est limited  .  h it; lire s  a  to  7 
show  this  sitiuition  (piile  tiramatieally  steady  slate  errors  in  the  estimates  td’  If^  and  It  are  'l  en 
to  be  (piite  small,  and  the  steady  state  error  eondition  for  them  is  reaelted  sooner  than  for  the  V  I . f 
111, Is  esliimdes  of  the  same  rtm. 

.\iiol lier  phenomenon  that  was  observed  was  an  apptureiil  linear  depeiuleney  I'elal loi oh ip 
.imonu  the  various  \'  1  .f  bias  estimates  uiuler  eerltiin  eondilioiis.  I'or  evamtile.  the  Kalman  lilterrinis 
lie  pie  ted  in  I'leui'es  a  to  7  eaii  attain  be  eit.  d.  Kimire'  .7  and  <)  show  situations  where  the  V I .  f  |  liiase 
leas  estimation  seems  to  be  proeeedmt;  as  expeeted  a  monotonieall v  lieereasint;  phase  Iiko  '  -lima 
I  loll  err  I  ir  for  eaeh  of  t  In  -  six  \'l  J-'  st.dions  ,i.'  more  and  more  data  is  proeessed  by  tin-  fill  er.  1  lo  .  i  v  i . 

I'  lit’  a'e  7  .  eorrespoiul  my  to  the  underdam  pi  .!.  fast  transient  response  easiu  indieai  es  a  very  di  fferei  i' 
situalion  for  X'l.K  phtise  bias  estimation.  There  is  an  initial,  rapii.l  imiirovenient  in  \'I.K  bias  esuma 
tion  for  the  lime  ranye  l)  to  70(1  see.  as  expected;  thim.  suddenly,  bias  errors  aetiiallv'  iiiereasi  ;n  fiVi' 
out  of  SIX  of  the  stations  duriiit;  the  time  r;int;<'  TOO  lo  1  HOO  see  i  i.e.  only  \'  1  .T  slat  ion  .\  beh.e, ,  -  a- 
i  -x  peeled  I.  I'.v  entiially .  beyond  I  SOO  see.  tin-  \'  LK  bias  e.si  i mat  ion  errors  decrease  to  ai  e,-]  a  al  ■  .  ■  in.il  i 
levels.  .\ote  that  estimation  of  the  biases  III  I,  |.  and  n  h  ,i'  is  eoinpletely  divorced  from  till-  I  l  ie.  1 
vvlieie.i'.  ilie  position  error,  especially  loiiyit late  error.  Is  obviously  stronttl.v  eorrela'nl  to  n. 

In  order  to  verify  the  suyttesled  hypothesis  of  linear  dependency  amony  \'  l.T'  phase  bias 
est  1  mates,  allot  111  Kalman  filter  run  was  executed  with  all  eomlitiotis  the  same  as  for  llii'  |  u'ev  loiis 
undi'i'dampisl.  fast  transient  response  ease  of  Kiyure  f  l  i.e.  larye  T  m  fable  1 .2  i.  exei'p;  liuit  no  \  I  f 

biases  were  simul.iled  III  the  mea.stiremeiil  of  VJ.f  phase  diffi'l'eiiees.  i  he  ecau  ern  was  that  die  elfe,  t 
bemy  .,bsi  rved  miylit  simply  be  the  result  of  havmy  larye  initial  diserepam  ies  in  tile  X'l.f  Ijms  esp 
iii.iti'-  vvliieli  somehow  elicited  (his  parlieiilar  response.  I  he  results  are  shown  in  the  plots  of 
I'  lyui'e  I  1  comparisons  with  I'  leure  7  show  that  the  V  1,1'’  bias  error  ri'sp<  uses  o I  i lie  t w a i  runs  are 
V  irl  ually  idem  u  al.  apart  from  the  first  .7U()  set  or  so.  I  his  vv ould  appear  to  remi oree  die  claim  that 
I  here  Is  some  iiihereiit  linear  relal  ion.shi|)  .uiioiiy  the  set  of  \'I,T  stations  chosen  that  eauses  the 
'IK  Idcii  111  crease  111  V I .  T  bias  err  I  irs  when  the  filter  d.imi  mi  y  is  low  . 

1  he  eonjeet tire  was  also  made  1  hat  tlu'  observ ed  mterael  Km  amony  V  I  .T  I n.is  ern  its  m  lylit 
be  a  fu  net  loll  of  yeoyrai  lineal  loeat  ion  lienee,  it  mmnt  be  associated  with  the  ;;eomet  ru  al  rehit  ion 
ship  bet  ween  the  \'  I,  f  stilt  lolls  and  the  aircraft 's  [.osit  ion.  I  o  test  out  t  his  i  heory .  aiiot  her  Kalman 
filler  run  w:is  m;ide  with  all  eondilioiis  the  s.mie  as  for  the  Tiyun-  7  run  except  that  the  startmu  poim 
was  111  the  middle  of  the  I );ivis  Strait  !  i.e.  70  N.  f>U  \V  i  instead  of  the-  (  )l  tawa  loi  at  ion  ( i .e.  1 .7  N. 

7  n  \V  I .  The  result  s  of  t  Ills  experiment  are  sliovrn  m  the  plots  o|  T  lyure  1  2.  and  demonstrate  v asl  1  v 
different  \'  I  .T  bias  error  ;md  posit  ion  error  responses  eompari'd  to  the  same  results  for  the  (  )l  i  a  wa 
I'M  at  ion  run.  show  ii  in  Fifiiiri-  7.  T'lirt  her  more,  plot  s  of  K  i'”.  '  ,md  T  as  fn  net  ions  oi  t  line  I  or 

tile  I  );iv  Is  :  rail  rim  (see  Fiy.  Id)  rev  eal  siynifK-ant  differences  w  heii  compared  I  o  the  i  ori'espondme 
|ilol  ■  (or  t  he  (  )t  law  a  run  I  see  Tie  1 1 1 1 ,  These  observed  dlflereiii  e.s  Would  I  hell  appear  to  be  can  SI  si  1 1\ 
a  ehanye  m  inier;ietion  amone  \'1,T  bias  eslim.des  resultmt;  from  the  siynificanl  shift  in  operatiny 
local  ion . 


In  order  to  compare  the  yeomet  ries  of  (he  V I  ,T  slat  ions  for  t  h  '■  two  d  iffereiit  operal  iny 
local  Kills  briny  considered,  a  T't  )|{  T  If  \.N  (iroyram  wiis  wrilt  en  which  plots  a  map  of  a  hem  isphere 
centred  at  any  specified  yeoyra|ihieal  position.  I  he  |irojeetion  Used  Is  an  a/imuthal  eipial  areii 
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(i.c.  I.anihiTl)  |)r()ji‘i  tiun,  whicli  allows  accurali'  measuri'nicnt  of  hearings  aiui  angles  on  the-  ina|).  This 
lypi'  of  inap  is  quito  useful  for  observing;  the  tieonraphieal  loi-ations  of  the  \'LK  stations  relative  to  the 
operating  position  assumed  for  the  aireraft.  A  linear  depeiuleiiey  amonu  l  ertain  \'LK  station  bias  esti 
mati's  will  probably  occur  it  two  or  more  \’LF  stations  are  almost  in-line  with  the  operating  position 
In  such  a  case  it  would  la-  very  difficult  for  the  Kalman  filter  to  resolve  the  indivitlual  station 
bias  estimates  atcurately  a  typical  filter  response  would  be  liir^c,  torrelalcd  nuctiiatioiis  in  the  Ina-, 
errors  lor  the  \'LF  stations  involved  in  the  linear  relationship. 

Figures  1  I  and  15  show  map  projections  centred  at  the  Ottawa  location  and  Davis  Str  ut 
location  res|)ectively  the  position  of  each  of  the  si.\  VLF  stations  is  also  indicated.  .\  'tudv  of  ih, 
projection  centred  at  Ottawa  (Fij;.  1  1)  reveals  that  VLF  stations  \V,  1).  anil  .\1  are  rouehiv  in  in  ■  w  ith 
the  Ottawa  lu-ea  operating  location.  Another  look  at  the  \’LF  jiha-se  bias  error  res|„,nses  l',,r  llie 
Ottawa  area  start  location  (i.e.  Fi^ts.  7  and  1 1 )  shows  that  the  bias  error  responses  nf  tliosi-  tins  ■ 
stations,  in  particular,  correlate  stronj;ly  durmt;  the  ‘larjje  amiilitiide'  region  from  TOi  io  iMiii  s.  ,  .\ 

series  of  Kalman  filter  experiments  involving  that  same  VLF  geometry,  w  here  eaih  \  LF  si  .a  i,  m  ei 
turn  is  projjrammed  for  no  bias  est miat ion  (by  setting  the  eho.sen  \’ LF  stat ion's  I’  elcmenl  \  alia  ’ ■  . 

zero ).  veril  les  I  hat  there  is  a  eonsistent  ly  strong  correlation  amonn  the  bia.s  error  respoiis.  s  1 1|  si  ,ii  ,  a 
U  ,  I).  and  M,  The  projee'  ion  cent  red  m  the  Dav  is  Strait  area  (  Fia.  1  5).  -ni  t  he  ot  her  haml .  dena  1 1 
t  rates  a  VLF  a>'onietry  vastly  different  to  that  of  the  <  fttawa  pro|eet  a  m.  I  lie  I  l.ivi'  Si  rail  prop  .  i . 
reveals  pairwise  VLF  station  eombmations  that  are  iiearK  in-line  with  the  pro|ei  iimi  erntia  \\  (  . 

D  ( ),  anil  .AM  (to  a  lesser  ex  t  en  I  I .  .\  elosc  Inok  at  1  he  VLF  bias  error  re  s  pi  nisi  -s  .ho  w  n  a  i  f  ,  i  >  1  .  ’ 
'.ndicates  definite  pairwise  correlations  for  each  of  (he  three  siation  pairs  cite, I  .iIm.v,  M-mcv,  i 
further  experiment  at  ion  eorroho  rales  (he  exis(ence  of  this  sci  of  eorri-lai  n  ne  .nnoni,  \  |,)  :  .n  ,,  .n  e  .. 

the  Davis  Strait  posit  ion. 

1  horoU(ih  in  vest  luat  ioi  i  ol  t  lie  \  LI*  linear  depi-nih  ‘iiev  pia  ibleni .  nm  hr  v  .ira  ■  .  -  a ;  ' 
has  demonstrated  that,  m  yeneral,  it  i'  possible  to  est  i mate  four  out  ol  six  l.ir^e  \  I ,  I-  i  a.i  -i  ■  ■ ,  na  i. .  , 
and  ai'curately  without  exeiina;  the  kind  of  linear  dependeiuy  inter.ietion  ih.ii  lesnlis  ■!_  nii,  .a,' 
position  error  for  a  (one  period  of  (ime.  l-'or  ex.tnqile.  a  Kalman  r  w.o  m.a  a,  a  i  ;, 

all  conditions  were  as  described  111  Tables  1.1  .md  1.2  (I.e.  the'larue'  1’  .  .oi  i.  i , jn  "  \l.l 

stat  ions  .\  and  1)  were  simulated  havmt;  no  bias  ( instead  of  Dip  .ee  i-ai  h  i  .md  l  hi  i  .  .rri  p-  '■  ,d  m,  I' 

element  val  lies  lor  .\  and  1)  were  set  at  0.1  p  see  eaeh  (I.e.  'sin  air  nisi  I  .III  of  '  l.nyi  -  i .  1  i  le  i  n  a  i  ■  i  P 
on  the  opera!  ion  of  the  Kalman  filter  was  to  wi  ir;ht  heaviK  the  .leeur.ile  init  nil  i  "iidii  n  m  ,ii h  .i  in.n  r  n . 
eolleernme  the  possible  biases  m  .\  and  D  W  bile  lie  we  ml  I  tint;  the  maeiiilMIe  initial  I  oedi!  S  ..a  a  m.i 
t  ion  eoni  ernmu  biases  m  the  ot  her  four  LF  stat  ions  ( i.e.  note  that  the  mil  nil  bias  ■  st  im.it'  -  oi 
\  LI'  stations  are  set  to  /ero  | .  !•  i  mire  1  (i  show  s  the  ph  n  s  i  if  i  .le  error  oiil  pii  t  s  fnr  t  h  o  pari  a  .h ,  i  r  'i  n  i 
It  can  be  seen  ( |  u  It  e  I'learlv  how  well  the  lour  larae  \  I,  F  biases  are  esi  nna  I  eil  while.  ,ii  the  ..mn  ;  1 1 1  a  . 
the  bias  estimates  for  .\  and  D  remain  eh).,..  t,i  /,  ro.  as  they  should  (mne  how  mm  h  inon  s.  nai  iv, 
the  seal  me  IS  for  the  bias  error  f  dots  of  .\  and  D). 

LI  Mandlinj'  VLF  Bias  Driftinj; 

()ne  typical  source  ol  error  in  \  LI*  measurements  is  caused  b\  a  phase  shift  in  one  iir  niMri- 
stat  Ion  phase  d  it  lerence  smnals  that  has  not  hint;  to  do  with  the  true  mot  nm  of  i  he  airera  ft  I  he  ran 
ol  this  phase  shifliili;  can  bv  fairly  constant  in  time  and  a  common  cause  is  Ilm  sn-i  ailed  diurnal  ship 
(sec  Ref.  15)  as  a  result  of  the  dav -nmiit  terminator  crossint;  a  (lartii  tilar  \'I.F  siaiiim  s  i  laiismissn  ,n 
path.  These  diurnal  shifts  can  have  rates  as  hiuli  as  20  p  see  per  hour  and  can  l.isi  for  a  couple  of  hours 
I'  II  rt  her  mo  re.  various  other  lo'ios  phene  d  ist  iirbaiiees  can  cause  jihase  shi  1 1  s  ol  a  more  ra  iidi  mi  i  lal  ure . 

It  then  becomes  important  to  find  out  whether  or  not  the  Doppler  \  LF  Kalman  filler  is  eonfitiuied 
to  handle  .'Ueh  VLF  phase  shifts. 

In  order  to  deal  with  the  assumption  of  a  driftint;  VLF  station  in  ihe  eonlexi  ol  ihe  Kalman 
Liter,  the  eoneepi  ol  a  VLI'  bias  whose  value  could  shift  III  time  was  eonsidereil.  Different  ni.  Ihods 
of  traekini;  this  time  variable  bias  were  then  tested.  For  example,  I  ables  l.;i  and  1.1  outline  ihe 
simulated  navigation  conditions  and  Ihe  Kalman  filter  initial  eonditions,  res| „Tt ivelv  .  lor  one  s,  rie., 
ol  ex|ieriment  s  that  were  Used  to  test  out  various  ways  of  handling  I  he  drift  mp  \’  LF  si  at  ion  sit  mil  a  m 
I  wo  V  1,1'  stat  lolls.  ( ;  and  .\I,  were  simulated  to  be  drift  mp’ s  im  ul  t  ancons  I  v  at  the  rat  her  h  ipli  r.il  es 
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of  ;?()  /j  sec, 'hour  and  72  scc/hour  rt'S|U'i  liv('ly .  Tht-  oilier  four  Vl-K  stations  were  simulatr-d  to  have 
only  vi>ry  small,  fixed  hiast's  of  0.1  /a  see  eai  h.  Both  \'I,K  station  drifts  started  halfway  throutjh  the 
Kalman  filter  run,  at  the  2500  see  point.  Kij;ur»‘  17  shows  the  Kalman  filter  output  error  plots  for  this 
situation,  with  no  use  heintt  made  of  any  a  prion  information  about  tiie  drifting  VI, F  stations.  The 
lietrimental  effei't  on  all  VI, F  bias  estimates,  as  well  as  on  basic  position  accuracy,  is  cpiite  evident 
oiici'  thi'  bias  drifting;  starts. 


r.\Bi,K  1.1 

SIMULA'I  KD  .N,\VI(:,\TI<)N  (’O.M)H  I(),\S 
FOR  ,\  DKIF  I INO  \  I,F  ,STATI(>N  KXl’KRI.MK.N  I 


True  start  position  ( I.at/l,onm 
Frror  m  start  [xisition 
True  t'rouiuispeed  (  Vm,  j,  I 

Bias  111  measurement  of  V  ||,,|, 

I  rue  track  (o  *■  p'l 

Bla^  m  measurement  of  o  s  p 

\  l.l'  'tations  (>  t‘i 

\  1,F  measuremenl  fnases  0.1  O.l 

I.F  drift  rate^  It'i.O 

^t.irtiin;  .it  t  2.‘>00  >ee 

No|  ,e  ^.iri.lllee,.  il  ^  1  O  k  llol  .  ir 

o  o  2 den  .  1 1 


1,5.0  7.5.0  den 
0.001  (1.001  den 
250.0  knots 

1  0.0  knots 

150  den 
1  0,1)  lien 

M  A  O  \S 

0  1  0  1  0  1  0  1  p  e  . 

’2  (1  M  'ei  III  nil 

0  25  <len 

1  (I  ^J  'l  l  .  ,ill  I 


III  eel  II  I  .il ,  1 1  \\  .1  s  fi  III  111  I  I  I'l  ’in  lie  iin  iikil  ion  i  \  pi  rimeiil '  t  h,il  a  i  In  1 1  in  .  >  m  in  n  e  .1'  el  ’ '  . 
\  I ,  |-  1 1 1.1 'I  ■'  1 1  Mill  SI  1 1 1 II  Ml  1  u  .11  I  I  111  111  ei  I  1 1  ir .  u .  mid  I  .11  I'l'  I  he  I  ii  her  \  I .  f  I  n.i  i-'i  i  m,i  n  i .  i  ,  i  r  | '  .e.\  i  , 

t n  nn  I  heir  true  ,ihie'  hu  .trial ily  ,  l his  \m mid  ■  .luse  the  1 ,  \  I  1 .( )\(  ■  pi isit n m  i  rn  vr -  l e  ai.  i .  i  ■■  .i 

.1-,  the  \  I ,  F  I  lias  I  Iril  I  inn  '  i  ml  iiiiiei  |  \ii  mt  ml  n  e  e\  plaii.il  loii  tor  I  hi'  pheiu  imeni  in  il '  m  n\  ' , . ! ' .  i . 

Ill  the  Kal  m.in  filter  e\  pen  men  i  jusi  i  lesi  tiIm-i  I  i  result'  in  1-  in  !<  i.  lie-  t  il  ter  I  ii  - 1  n  i  m  lei  2 .  .oi  i  i  . 

u  It  h  MO  V  I .  f  I  ii.is  I  In  ft '  oi  l  iirrmn  lb  t  2.5()il  sei  .  .ill  \  I  I-  I  n.tses  .ire  esi  mi.iiei  1  ,i.  ,  n  . n .  !  \  i  i  .  1. .  . 

to  their  I  rue  V  .lilies  ot  0  1  p  see  eai  h  I  .  si  i  I  he  .ls',i  ii  lal  ed  F  m.ll  ri\  I  .1  post  erior  1  I  I  '  \  .111.1 1 1.  I  1 1  M  1  I  .  s  I 

I  hanonal  .lemeMl '  u  ill  .ill  he  i|iMte  'inall  In  ol  l.'-r  w  i  iii  N.  hv  ei  mi  pul  mil;  m  r\  .111,1 1 1  1  n.i'  1  11 .  .r  .,11  .1;  1  . 

the  K.ll  Mia  1 1  filler  1 1  'll  f  1  I  I  M'll  lers  ill  \  1,1'  I  n.i  -  es|  un.tle  -  to  he  I  |lllle  .li  i  Ilf.  it  i  it  I  1 11  t  e  ,  ,  ■  i  i  '  ,  :  i  ,.  \ 

I  2.5l  II  I  .11  I  he  I  n.i'i' .  Ill  \'  I  f  I  .It  loM'  (  I  .mil  M  I  le.aiii  to  I  Iri  fl  .It  1  In  'pe.  il  e  ,  1  i  .n  .  \  ■  • ,.  ■  .  i  i  . 

Ml  (  I  .Mil  I  '  11  u  rease.  I  he  elTi  irs  Ml  I  he  Kaim.lll  filter  i-'l  im.lte'  I  ||  I  llese  1  I|,|,es  ;  ,1,  .  .  .'Ill . . 

mnlv  I  II  lU  e\  er  .  I  lee.lMse  I  he  \  .main  !■'  I  if  .ill  \  I  .  I-  I  n.ls  e- t  linate'  ,iri  i  |ll  lle  .m.lli  ■  ..  n\  'm  hi.l  'll  I 

\  I  .  I-  1.1 1  H  III'  (  '■  .Mil  I  M  .ire  .11  I  1  pt  ed  h\  lie  K  .ll  lll.l  11  f  ll  t  ef  a'  ’.lei  1  irat  e  esI  MM  ,ll  e  ,  |,  ||  ,  ...  ;  ,  .  '  .  !  i 

.  I,  111 ,  I  hese  errors  I  111  lid  M  p  .nil  1  I A  III  I  M.ll  l\  .  .ni  .e  i  he  <  n  her  \  I.  f  I  ii.is  •  si  mi.n.  ; . .  n  i.  i .  i  .  ■ ,  me  i 

.  hie  to  I  111  hlle.ir  n  l.ll  II  Mi'll  ip  e  \  1,1  MU,'  .1  Me  llie  \’  1  ,1'  .1  .it  ion  hlases,  (  (I  I  I  nil  '1  •  M,  i  .,1  .  i  I  .  il  ;  ... 

.1  ro  I  Mill  1  he  pi,  Ml  I  M  pi  l.ll  e  I'miat  loll  11  ir  \  1  ,  f  I  11,1'  si  .It  es.  V\  h  11  h  Is  not  I  olTe.  I  ',1  I  I  I  1  .  1. 1  .  I  I  t  ’  , .  I  ;  .  , 

1 11  I  iirs 


TABLE  4.4 


KALMAN  FILTER  INITIAL  CONDITIONS 
FOR  DRirriNG  VLF  STATION  EXPERIMENT 


Position:  PL.\T^, /PLONG__  - 
Bias  in  Doppler  ^oundspeod:  B^  ^^ 

Bias  in  true  traek:  B 

a  t) 

Biases  in  VLF  phase  measurements:  B,  ( i  =  1 ,  .  .  .  ,  ()l 

Noise  varianc(‘ li'vels  Same  as  Tahk'  1 .3 
Error  eovariani-e  matrix,  P  ^ : 

Variance  of  PLA  I\,:  (1.1  I 

Variance  of  P LONG  :  P  ^  (2,2) 

N'anancc  of  11^  :  P  ( I 

Vanani'c  of  H  :  P  (  1 , 1 1 

X'ananccs  of  H  :  P  (5,5)  *1’  (lO.lOi 


15.001/75.001  dctz 
0.0  knot 
0.0  det- 
0.0  p  ncc:  all  i 


1.0  clc^;- 
l.Odcu- 

100,0  knoi - 
lUO.O  dvu’ 

11  1  p  “-ca  ‘  ;  .ill  I 


In  order  lo  compcn.^atc  for  VLF  bias  drift inp.  wit hou(  i  hanump  i  he  plant  u pdale  nn  idi  1 1  ini; . 
il  liccaine  oh\iou>  that  the  appro[iriatc  i’  matrix  diapoiuil  clement,'  would  ha^e  to  Pc  .idjU'icd  durmc 

the  drift  period  III  onlcr  to  counter  this  tendency  of  error  huild  up'  in  the  K.ilin.m  liller  I  w  o  metiioo 
of  P  matrix  adiU'I  ineiil  were  attempted  : 

II  Kc'Ct  I  he  appropriate  \'  LF  Plti'  iTror  covariance  lev  ep  lo  larci  \  .due'  al  the  Pee  im  i  u  i-  '  '  | 
the  I iia'  drift  [leriod  in  order  to  'tell'  the  K.ilni.in  filter  t h.it  t hc'e  part  a  ul.ir  Pia'  e'l  m:,il ■ 
Would  Pei  lime  inaccurate.  Put  let  P  propacate  norm.illv,  afn  r  that  I  hi'  tei  hiupai  pio\'  u 

to  Pe  Un'Ueee"ful  III  reduemp  the  effeel'  ol  Pl.l'  drilt  I  n  fo  rl  1 1 1 M I  e  I  \  .lllir  iihlv  .1  ieu 
It  era!  loll'  o  f  t  he  Kalman  uiiilate  e(|u.i(  loii',  |  la  i  mil  lallv  i  larpi  \  I .  f  Pi.i'  .  i  .  \  ar  ;.m.  e  1.  \  el  - 
w  ere  I  inee  .ipaiii  a  I  'inall  vahu-'  Since  the  I  u.t'i  -  v\  ere  'Ul',  Ovit  t  lie,:  .it  t  li.c  p-  ■  :  a  .  lei  ;!  a  .cat 
i-rror'  m  Pot  h  \’  I  ,!•  I  nax  C't  im.it  ion  and  pO'it  am  c'l  im.it  iou  then  oi  .  urii  0 

III  Maintain  tin  appro  prial  e  \'  L  F  I  ua'  error  eov  .irianec'  m  I  Im  I  ’  n  i.il  i  :  \  it  1 1  icI  i  v  .1 1 1  a-'  ;!•>-<  n.i": 

mil  tur  en  Ore  ,lnl  I  /a  ru  id  1  hi'  fori  e-  the  .  o\  aria  la  e  element'  ol  1  nl  ei  e-,!  lo  1  eiiMiii  .h  On 
'aiiie  hivtli  lev  el  from  one  it  er,  it  am  to  the  next  SiaP  .1  |  no.  eiluie  vv  ,1.  :  ound  to  ■  .  u  1 1  p.  1 .  .a  • 
for  the  Ilia-  1  Iri  fl  -  r.il  laf  vm'II  Ite.  .lu  -e  1  he  p.irl  a  ular  \  I  i-  i  na-  .  ov  .11  i.iia  e-  vv  1  re  kept  1 1  v  e.  I 
.It  l.iree  value',  the  efle.  I  -  ol  the  Pla'  dril  I  me  Were  not  I  r.lll'lnlt  I  ei  I  I  o  111.  I  1|  her  \  I  f  I  1 1, 1 
•  ■'t  im.il  1'.  nor  to  1  la  p.  oil  a  m  e  1  im.iti'  \  .  .non  .e  I  tie  Pi, a-  .Iril  I  me  -I  opped .  the  P  n  mI  1  1  x 

v.i'  .illovveil  III  prop, ic. lie  norm.illv  attain  I  he  output  error  plot-  o|  1-1x1111  1  .s  ar.  ■  mi 

I  X  .1  tuple  ol  till-  pro.  ei  I  n  re  I  nine  .Ipplleil  -la  i  e"|  nil  V  In  I  In  -  .  .l-e  ,  ,ill  I  he  1  1.1  nd  1 1  loll'  .III 
a  li-nl  I.  ,il  III  I  la  le  I  j  f  I  la  K  .ilm.in  I  ilti-r  run  'povvn  in  1-  in  1  in  IT  1  ,ind  pri  v  lonsl  y  de'iiiP'  .  1 1 


fM'i'pt  t luit  I’  ( (>,r> I  iiiul  I’  I  7 .7  I.  corn -SIM Ultimo  to  luaso  in  V  1,1-'  -.lulioiis  ( i  .nul  M .  .iri-  i h 
lixt'd  at  100  /j  SIT-  I ’aril  lor  I  ■  2.700  mt.  Asa  result ,  no  apiireeial  ile  error  sliow  s  up  in 
estmiaUon  of  the  other  \’LI''  biases,  and  the  posuion  estimates  ri'in.iin  a*  >  uiatu  l  uroiei 
more.  I  he  ilril't  mtt  biases  id'  A  1.1'  stations  ('•  and  M  are  aeiually  esl  imaled  '  pi  iti'  a  >  ! !  ‘  'ii  i 
average  the  rather  hit;h  noise  levels  m  thesi-  esi  nnates  result  (rom  a  l.u  k  o/  ,,n\  .im  >o; ; 

elt'eet  for  bias  estimation  when  the  l‘  elements  are  set  so  liipll  in  value  A>  Ui.dlV  111'  Isi 

lev  els  oil  the  drift  mu  buis  esl  1  mates  >  or  res  pond  to  the  v  ariam  e  s|  leei  (  k  .it  loiis  tor  tie  u  n 
lated  \'  1 .  K  station  noise  proeesse^  (  l  e.  1  O  /J  see  '  1  \oti  th.ll  the  'la  1  e..^  ol  On-  .ippl  .  .,e 
relies  eiit  irely  on  k  I  low  mu  w  hen  any  p.irl  leular  \  1 ,1-  'tat  ion  is  iik.l  v  to  i  .e  ori  M  inn 
is  I  ert  ainly  feasible  for  I  he  d  mr  mil  drift  ease,  m  part  leular 

A  MO  I  her  mod  if  lealion  w  il  h  m  the  K.il  man  filter  ■  .m  I  m  used  to  ehm  m.it  e  .m  v  ,e  i . .  i  -  .  .  !  b 
fn  Mil  dri  I  Miiu  \  1 . 1-  biases  namel  V  .  .  haiu;e  the  appropri.ib  i  leimnt  -  ol  the  It  in.il  1 1  •.  .a  ad;:..,.. 

I  o  s  ,i!!  t  li.ii  !  he  i;  Ilia  I  ri  \  iiid  M  .d  es  1 1  >  I  he  K  .lim.in  flltei  .  V  la  .ippi  oMiii.ih  ■  I  .d  .-t  a  ■  ■  a  l  ia  ai  i'  ■  ■  \ 

:  a'  '  a  I  !  I'  Us,  pro,  ess,  s.  I  hi  I '  lal  IV 1  w  I  aejil  eiu  I  h,d  ■  la  ,1  .id  Ol-  pan  '-d  .  .11  .  .a  il  "I  '  1 1,  a  .  a: ,  : . .  M 

O' 1.1  a  ■  1  i ;  I'fi  I'ei ,,  ,  iia-.i-iir,  ineii!  -  I'.v  s,  tiineanv  paib'ui.ii  I,'  .'iMlriv  ilauonai  ,  a  iiaan  io,.,,i  i,i 

;  :  _  n  ,  e  V  ai  I  le  , , :  a  ,  .ii  i  \  :r  I  n  ,i  1 1  v  e|  i ,  n  n  i.il ,  In,  ,  i  - ,  ■  ,  .ri  ■  p,  'la  I .  ni,:  \  I .  f  - .i '  -  on  i-' 

'  1  '  •  1  I  ,  r  1  \  a  n ,  p  •  1 1  f  .  a ' ,  I',  I  0  . 1 11  ! ! . .  i  -  h  •  i  ,  h. n  i ,,  e .  t '.  i ,  i  •  s  |  n ,  i .  i  .  a  •  .  ■  a  -  :  .  .  ' 

’  . '  f  ,  jni  e  1  .  ,  \  I  ■  p;  : !  i.il  11  i  2 .2  ,  .n .,  i  I,  ,  '  '■<  ,  .  ,ro  '  ■  ■  ;  .  .e  i.e  ,  .  .  ■ 

.  .Il  on,'  I  ,  in,  1  \I  h.iv ,  lie,  n  1',-- ,  :  lo  !  oolio  -  ,  ■■  ■  :  .,Oo  ,  .  In-i.-.o-.i.e-'s'',- 

I ■  1 1 n  . 1 1  .ip  .  I .:  1  h,  ■  i  li i.is,  11  a  -.1  II ,  n  a  '  ■  I  . i  .  , n,  i  M  I  r,  ■  m  '  ■ K ,  I  .  ■ .  i  -o, . , '  a  ■ ; ,  ! ,  a  '  '  •  u  i , ; '  - 

'  ■  1 : ,  I ,  \  -  .1  I',  '  u  1 1  ,  I  la  ■  did  t  :n..'  \  I .  f  o.M  -  .  -  n,.i .  ■ .  ■  i.  o  . .  '  l  a  . , ' :  a -t  \  I ,  I  oi.i-,’,' 

•  ‘  ■  I  a  ,n  a  ,  Ml -  11  nil II I  an  a-,  I  \  ■  .  .mo.ir  -  a  i  r,  -  r  i  1 1  ■  un  f  ir,  1  '  ,e  <  I  1  .  .i  ■ 

ill'  .If,  b  i.iP  ,1 1  larl  1 1  a  Mil  III,  \  I .  I  .  ,|.i  -  .  ri  ,1  ■  ,  ■  I  1  ’■  .0,1  M  ■  ■  oi :  ,,-r  ,  re  ,i  a  ,-  ■>  '  a  ; 

"  '  V '  ■>  n  '  h,  ■  1  w  ,  I  pi,  IP-  I  n  U  .  Ill  ,d  it  V  Iin:  ,  .1  n,  !  I  la  U  in.,'  i  ,  Oa  I '  -n.  d  i  •  ’la 

'  ,  ol  la  r  I  ,d  ,  ,  -  st  ill  i.d,  -  '  I  ill  ,  fd  h  (.  la  e  a. ,  ,  ,,  n'a  :  j  i  n ..  .  i-,  .. 

'  .  n  1,1 :  io!  1  I',  ■  -  pi  >11  -e  ,  it  I  la  d  ri  1 1  mu  \  1 .  f  i  .d.  ,  ,  <  .  :  \l  Mo,  1  d  '  s  'li  >  ,  I  '  a  I '  : :  .el  ■■  ;  i  a-  :■ 

n  -1  '  r.i,  ki  1  lu  of  Ol,  ,  h  i!  1 1 iiL  V  1  I  :  •  ,i ->  •.  ■!,  i ■  a ,■  ,,l  I  ,  .n  ■  h'  >  i  >>  : .o;  i 

f  . .  iia  1  o  0 , .  ■  \  I ,  f  1 1  ,.i  , '  1 1 11 1,1 1  a  ,1 1  ,-rroi  l  >  ,|  •  .  ,i ,,  I  M  ■  . .  I  ■ ,  p  i  .ipa  1  ■  v  >  >1 ,  ,  ,  1 1  : 1 1  .n ;  ,ir '  1  i  a  , 

,  1  I  - ,  d  i,  Ml  ,  rt'or  ■  •  . .  I  a  ,  ,  I  iiiui',  t.ir.;,-  d  l ,  i  ■  li  .1  ’  ; i  „  n  i .  e,  .  .  •  i  ,■  .  .  ,ri .  . . . .  n.  1 '  ..Ml 

h.i.’on.il  >'1,  'III,  n  I  -lav  -n  i,i  II  w  h  ih  1 1  a  ■  I  ,  .n  a  I  M  \  I  f  pi ,  .i--,  d.d  ■  o.  it  la  -.r ,  a  I  d  >  ,  I  >  >1 1  a  ,  I  ,e  I  1 1 
I  irM  a  r  \  I .  f  I  a.i '  ,  ■  -  I  iiii.d  ion  ,  ,d  l,  inpl  >■>  i  h  ,r  1 1 I  ,|.1  ■>■  ■  .n  (  .  .uid  M  l  "V  >  •n,  l  '  2 .  ,Oi  2  ,  In,  h' 

[lev  .iiiumeiil  d  loi  i  or,,,  ,'d,ii,  -ia.iil.l  i  „  ■  . .i.!.-r,-,|  'n  .i  '.ei  r•■s,.rl  -d.ni'a,'.  wn,  o  ,,r  ; 

I  1-  -l.i I  a  Ml  -  ir*'  1 1 1  ■  U'  I .  ,,,,,,>  ■  p  1  1 1  :i  V  o  V ,  I,  n  ,  o,,  p,  .n , i  ,  ,1  |, ,  .  ,  ,i  snan.d  ,  1 1  ..d  1  n.  \  in ■ ,  1  1 ,.  .  2 n , ; 

,  ni  ir,  I fr,  111  i  III,'  K.il  Ilia  11  I  il! ,  r  -,  ,i,d  a  ,n 


I  I  a  I  i  1  1!  '  III  1  I  '  ,  ,  I ,  M  :  I  I  I  .  >  . 


n  .  I  p.ll  I  a  :  .1.11  \  I  I  I  11.1  . 


n.  . 
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iiLl  A  siaiiDH  lrai\smissu)n  may  dflcnoraU-  in  quality,  i-vi-n  to  llic  pumV  oi  a  ii)>>  <it  ^mnal' 
status  in  the  airural't  \’LI''  n'cnivur  fur  a  ccrtam  t'nriod  of  tinif,  lAcnlually ,  llir  \'l,l-  ^it;iial 
will  l)(‘  rc-acquircil  with  cither 

a  I  an  iiicorri'ct  (ihasc  reading,  or 

111  till' correct  phase  displaccil  by  an  intcticr  multiple  of  wavclcn^th^  from  uhat  it  'honld 
he  I  known  as  lane  jumpinitl. 

In  order  to  make  effeetu e  use  of  the  \’ l.k'  data  iii  the  eonle\ t  of  a  Kalman  na  \  i^at loi i  I  iln  r . 
it  i>  imperative  that  Mime  Mirt  of  eoiii  ini^enev  plan  nine  hr  ih-termiiied  for  deteelmy  and  handlniu  ■  .e  h 
'  if  the  \'  l.K  problem^  just  desenlied .  d  o  till-,  end.  consider  the  followme  fui-  \'  l.p  ■■.ei-narii  o'  w  uii 
■-neae^t,■(l  solutioio: 

1  I  (  hanee  in  \’ h K  noise  eharai  ter  if  one  or  mori'  \' I , K  stat ions  are  detected  i , ,  have 

I  lie  reaped,  or  decreased,  iheir  i  iliase  niea>urenient  iioi.-.e  le\  eh  d  urine  fheh  t .  roueii  e-t  miati 
1  d'  ihe  new  noiM'  vanaiiee  levels  can  replace  the  initial  values  m  ihe  appropri.ite  I;  inairr-. 

d  laeonal  local  ion-  .\  method  of  esii  matin  \  I.  f  nietisurenieiil  noi.-e  v  ariaiii  e,  m  Ij  a  ,1 1 
he  descrihed  suh-equent  ly  . 

:’i  Siiil’  inkl.f  pn.ee  if  a  diurnai  shifl  I  or  \' I.K  oais  eiianae  lor  anv  oi  ler  le.eoa  i  . 

dei,-e|e,j,  lee  appropriate  I’  nialiax  diauonal  element  .  an  he  li\ed  at  .i  lai'_e  vanae  -a.  h  e- 

I '  '  .a  sei  I  he  1  line  \  ,ir\  me  \  1 .1-  inas  can  then  he  trucked  a<  eurateiy  h\  I  lie  Kai  man 
Idler  \\  lien  Inal  parli.  ular  bias  stops  tlriftine.  the  modified  I’  niatriN  eienien:  .  ,m  oe 

■  illo  v\  1  d  to  pro|  lavtai  e  normal  I  \  aeain ,  .\  met  hoi  I  for  d  mi  inhuisliina  hei  vv  een  a  idde.  i  \  I .  f 
inas  'll  1  Id  and  a  \d .  K  lanse  |iroeess  increase  will  he  -uaecsiei  I  low  ards  the  el  lit  ol  i  h. ,  -  1  naplei 

i  I  I  .os,  o  r  \'  1  d-'  siaiial  it  a  \  I .  f  'lal  |on  e\  pencil  i  is  a  lossi  >1  ^la:  lal  sit  uat  am.  I  In  ■  as-oeiat  ed 
K  ina!  n.\  diaei  mal  element  slwaild  l;e  me  leased  to  a  v  vvy  larvte  \  aUie.  sin  li  a'  \  t'  ,  .i  i  order 

t  o  I  him : lat e  1  i la!  ,|  at  ion  1  rom  tin-  K.dinan  filter  'oiiii  a m.  InviieaMoi,  o|  a  'l  al.on  dow  1 1 ' 
'Iain,  1,  !  r.ni'mit ;  ed  to  ihe  Kalman  filter  alaoril  hm  l  yv  vv  av  of  a  \  I ,  f  t'lav  for  .  ai  ii  't.  it  ion 
III  ,1  at  ion  dow  1 1  1  ,lal  Ion  iq  It  I  hat  is  inherent  lo  i  le  -  d  in uai  proee,,]ne  ot  i  iie  I  .!■ 

pha  ,1  data. 

I  I  U  e  ai  q  II  isi  I  Ion  o  1  1, 1-  sieiial  if  a  \  l.f  -.lal  imi  ei  mies  hack  i  ei  line  after  i  icihl.  dow  n  .  I  he 

I  ollow  ma  mu 'I  he  done  hi 'll  It'.-  usim;  i  hat  station  autnn  in  the  K  til  man  1  ill  er . 

cheek  nonimal  noise  level  of  the  si.iiKm  hv  measiniiu;  its  tq iprn\ imat e  noise  variaiii  i 

1  heck  \  l.l-  phase  measureiiiem  '  horn  ina!  sialion  for  ,hifl'  and  waveleiieiii  |inn|', 

re, el  Ihe  .ippi'opriale  \  I .  K  flai;  w  hen  il  v  erified  1 1  ml  die  ,1  al  ion  i  ■  peinna  i  jenl  i\  h.n  k 
on  line 

Allen  a  \  l.l-  shilioii's  phase  ineasiireineiit  data  o  to  lie  hron',thl  hai  k  into  ihe  K.ihn.in  liiti  r 
ohilinn.  die  .i|  i|  iri  iprial  e  It  tnid  I’  matrix  diattonal  i-lemenls  must  In-  reset  ai  i  oii  I  ii  lulv 

I  lie  \  I  I'  noi'i  \  an.nii  e  lev  el  i  hei  k  will  yield  a  new  v  alue  for  die  I;  m.ii  nx  d  .mona: 

element .  a  lid  die  vv  .IV  elenadi  elii'ek  Will  so>'i  oil  I  ally  uro.s,  hia-  i-rri  ir  due  i  o  l.im  e  ,  m  pme 
I  lie  W  .IV  elenath  cheek  Is  a  11 1 1 1 11111 1  H  Xl  1 1 V  taken  I  tire  Ilf  III  the  present  d  lUU  ,ll  pl'i  M  es'ilu;  ol 
\  l.f  onboard  die  ('onvair  When  die  stalnni  p  fmalh  ii,ed  m  tin  lilii  r  .iL'ain,  llie 

initial  esinnale  ol  its  Intis  should  he  /ero.  llowcM-r.  die  eorrespondme  milial  \  l.f  liia, 
error  v  .irianee  si  n  mid  he  larite  to  re  fleet  a  feelinu  that  there  |Ust  miuht  hi  some  Inas  mn 
.11  1  onnied  for  m  the  ph.ise  measurements.  Hopefully,  then,  the  Kalman  liller  vmII  respoml 
qnn  kly  to  esinnale  any  mm/ero  bias  that  still  exists  m  the  station  i  onmn;  hack  np.  e\  i  n 
after  VI. I'  dittital  proeessmt; 


.) )  C'( iinplcli'  l()s>  1)1  \'  LK  ^i^nal;>  in  a  i-asc,  all  1{  inalri\  tiianonal  I'Icnicnts  m lie  in 

i  ri'aM'il  lo  \ahii's  like  10'  iliinii'a  tlu'  \’1.F  i)Utaf;i';  tlu'  Kalman  rillcf  i>  tliim  na\  ij^aunn  on 
l)n|)|ilrr  hcadim;  inlDt'inalum  nnly.  A).).uminf;  no  aia-uratn  iiositum  rclcri’iui'  al  tlm 

tmii  III'  \'l.l''  I'lvstart,  a  .sit  iial  nni  would  laii.si-  ihi-  most  .scmtc  siiulnii'  iiroliii’iii'.  II  all 

till'  \'  I  .!■'  slat  tolls  am  down  tor  onl  v  a  short  pt-nod  of  t  imi‘  Isay  ten  minulns  or  li's.o. 

Hop  pi  or  head  mu  na\  luat  ton  can  la-  ^•onsU^^■r'•d  to  la-  ijuilf  aiaurali-  I'spi'i  tally  w  it  ti  tin 
I'oppli'f  hi'admu  hiasi's  woll  l■stlmall■d  from  tlif  Kalman  filter.  Wlum  liie  \'l,l-  -talion~  aie 
i  i  -  ae(|  Hired ,  I  he  elu'ek  proeiiluri-s  outimeil  in  I  i  ean  la-  follow a-d  lo  null  oul  an>  ui'os-  \  1 , 
leases  anil  i,>  estahlisli  new  \'LK  noisi'  \arianee  leo-ls.  with  lloppler  In  admu  np'lati  d  iio~, 

I  ion  I  'e  tiu  Used  as  the  aeeiirate  refereiiee.  .\ll  \'  1 .1-  I  lias  estimates  woulii  la-  ri'-iiu;  lah/eei  1 1 
/.ero,  with  I  he  e(  irrespoiidinu  mit  lal  hias  error  tana  nees  si -t  at  relat  i  \  ely  small  \  al  ues  e  \ ,  ep 
possil  ily  I  or  a  eoii  pie  o  f  s|  al  lolls  t  hat  are  know  II  l  o  exhihit  I  uas  shi  ft  mu. 

II  all  \'  I .  I-  si  at  ioiis  are  down  for  a  loiiu  period  of  lime  i  stiy  an  non:'  or  more  i  i  i  a  .n  oia-  i  ,tn 
expeet  I  loppler  headmu  pO'it  ion  error  to  merea.se  at  a  nominal  rate  )|  d  •  hum  niiii 

I  hus.  the  Doppler  headmu  posuiou  will  he  maeeurate  wlnm  the  \  1,1'  't.ilion'  .j 

au.mi .  \\  It  limit  any  othi-r  11100  •  aeeurati'  souree  of  position  m  to  nil  at  ion .  t  lie  Kalman  I  ;  in  ; 
w  ill  siinpK  have  lo  eoiitiiuu'  oil  m  a  iteuradi'd  mode  of  opM'iat  ion.  1  he  \  I  .!■'  -lat  a  'to  n.  et 
he  r■'-mn  lah/i'd  hased  on  the  iiiaeeurati’  Doppler  headmu  position:  howmef,  on,  .  on-oi  1 
I  toil  Is  (he  fuel  that  the  po-u  ion  enn  >1'  should  not  eont  UUli’  to  IK  o  ;■  -  e  o  1 1.  e  \  1  f  ,  -  :  mi  :. 

line. 


In-l'litfht  Mea.sun'mem  of  \'ld-  I’lurse  \  arianee 

Die  1 1  n-uround  iiieasui'emeiil  o  f  indo  idual  \’  I  .I-  si  a  i  'on  pi  i  a  si  nn  a'tirem.  i  u  -  lal .  a  . 
,u  1  omphshei I  111  a  \  I'l'v  si raiuiil  forw ahl  manner.  Sua  e  t he  aireral  i  o  'lal  lonary .  a  s,  fir n  of  \  | ,  I  n ,  i  i 
si'eoiid  readmus  I'tUI  he  Usi'd  dirm  tl\'  for  llli'an  and  vanaia  ,  ealeiilations  \  e|  of  :iho  ,(  ,1(1  \  1.1 

measureiiii'nls  i  i  e,  a  fn.  i'  mm  Lite  eolleetion  of  \'  l.f  data  i  w  o,::d  lie  s  iffi,  a-nl  to  .trni  e  at  ■  ■  a  o;  ..h 

leeiira te  ealeu lat  loll  of  the  mean  \  aliie  and  \  arianee.  |  he  nie:in  al-.u'  ■■  i  .  ah  . :1a h  <1  .n i  . . . .  i '  n  '  . , 

tile  t  lieoret  leal,  eoiisiaiu  .  miei'i  iseeoiid  \  mini'  for  I  he  known  ui'i  aiiii  i  posu  jon.  :n  oro'-r  'o  ii  teium  , 
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l.r>.;i  Deteetiny  \1.1'  Mias  Shifts 

1  he  I  Tn  ir  sequel  lee,  y  h  .  rail  also  he  Usi'd  for  deieetinu  hias  sll  i  fls  in  I  he  dl  f  I'el'enl  \  l.|- 

stilt  ion  phase  measurements  Keen  11  t  hat  thi'  noise  [iroeess  inherent  to  eaeh  of  the  \  1 .1'  mii'rosei  (Hid 
distance  siynals  is  assumed  to  hasc  a  /.ero  mean  and  eoiislanl  \ariani c  lor  tile  purposes  of  ih,.  Kaiui.ci 
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fliyht  are  the  followiny. 
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IhtMi  a  t)ossibU>  l)ias  shift  will  be  siispwti'd.  In  order  lo  avoid  I'onfusion  from  momentary  'ftlitches'  of 
large  value,  y  "  h  should  be  tested  for  a  series  of  suei-essive  values  before  the  decision  is  reached  that 

a  bias  shift  has  occurretl.  For  c\am|)le,  the  mean  and  variance  calculation  from  one  set  of  30  data 
points  of  y  -  h  couki  be  used  for  comparison  with  the  next  30  datapoints  in  order  to  check  for  a 

possible  bias  shift.  If  all  30  liatupoints  pass  some  sort  of  tolerance  test  when  checked,  then  a  new  mean 
and  variaiu'c  arc  calculated.  Ilowi'ver.  if  one  or  more  of  the  data|)oints  do  not  pass  tin-  tolerance  test, 
a  furthiT  test  is  done  to  verify  that  a  bias  shift  has  taken  place. 

lot  of  ‘fint‘  tuning'  will  have  to  be  doni-  in  order  to  have  the  suggested  algorithm,  and 
otner  algorithms  for  haiulling  V'1,F  [irolik’nis,  work  (iroperlv’  with  real  data.  .Although  most  of  the 
\'LF  contingency  situations  described  in  this  section  have  been  programmed  as  part  of  the  Ktilman 
filter  simulation  routine,  most  of  the  verification  of  the  logic  has  been  reserved  for  future  work 


,5.0  .A  C'OMP.AUl.sON  OF  FIVE  DIFFERENT  NAVIOATION  ALGORI  l'llMS 

In  this  I'hapter,  tht'  navigation  errors  of  various  simpler  tilternatives  to  the  Kalman  naviga¬ 
tion  filter  are  analyzed  and  I'omptiretl  lo  the  results  using  the  Kalman  filter  approach.  .A  set  of 
simulation  e\[)crim(>nl.s  is  described  whir  li  involves  comparing  five  different  navigation  algorithms, 
with  a  range  of  accuracy  s|iccifications  on  the  basic  ilala  (|uantilies.  I'hc  five  navigation  algorithms 
are  further  compared  using  real  ilata  acciuired  onboard  the  .\.AK  c'onvair. 

0.1  Description  of  the  Five  Navigation  Algorithms 

Five  different  navigation  algorithms  were  considered  for  a  comparison  study  and  evaluation. 

namely 

i)  Doppicr/heading  only, 
li)  A'LFonly. 

liil  Doppler; V FF  complementary  filter. 

iv)  .A  'naivi''  version  of  the  Doppler/VLF  Kalman  filter, 

V)  .\  'smart'  version  of  the  Doppk'rA'LF  Kalman  filter  navigator. 

Brief  descri()tions  of  these  navigation  schemes  are  as  follows; 

i)  Doppler ,1  leading  .Navigation  This  form  of  navigation  is  also  called  simply.  'Doppler  only', 
with  the  tacit  assumption  that  compass  heading  is  always  available.  .A  Doppler  heading 
navigation  scheme  is  based  on  using  the  measured,  or  derivi'd,  (luanlities  V|u|  p.  o.  v  ,  \'.\H 

(henci'  j3).  as  described  in  Section  3.2.  From  these  Dojipler 'heading  quantities  the  rates  of 
change  of  latitude  and  longitude.  FLAT  and  PEDNt;  respectively,  can  be  expressed  as. 


I'LA'J' 


(>077  •  p  •  cos  (<v  +  (J) 

00  •  [o077  31  •  cos  Dr  •  PLAT/90)] 


IM.ONG  = 

00 


'  0077  •  V„,,p  •  sin  (a  -r  fi) 

cos  (PLAT  •  rr/lHO)  •  j^0077  31  •  cos  ( rr  •  PLA'l'/'tO)] 


(5,1  I 
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where  PLAT  ami  PLONCI  are  in  the  dimensK)iis  of  {teot^raphic  al  clefjrees;  j,  is  iti  the 
(iinn'iisions  of  nni/see;  a  aiicl  fi  are  in  the  dimensions  of  radians. 

For  the  Convair  researi  li  aircraft,  the  l)oppler/!u-ac  intj  navifjation  parameters  arc‘  sampled 
twice  per  second  litis  is  then  the  sampling  rate  a.ssumed  in  the  navigation  simulation.  .\ 
trapezoidal  version  of  ciittital  mtc“(jration  is  used  to  compute  the  Doppler;  headintt  u[)dates 
I’l^.AT  (j),  PLONt’i  (j)  -  at  time's  t^  0.2  •  j  sec,  as  follows: 


l>LAT(j)  =  PLAT(j-  1)  +  -[pLA  rijl  +  PI,A  T  (j  1)] 

0.5  f-  ■  -1 

PLONtilj)  =  PLONtltj-l)  +  ^  •  [PLONDtjl  >  I’LUNtKj  1) 


(5.2) 


Tht'  accuracy  of  tiiis  form  of  navigation  is  directly  dependent  on  the  accuracy  of  the 
assumed  start  position  PL.\T(0l,  PLONC’i)0)  as  well  as  the  acc  uracy  of  the  Doppler  and 
heading'  data  used  in  the  mtettration  at{torithm.  .Any  error  in  the  spec  ification  of  start  posi¬ 
tion  will  always  he  retained;  but,  more  imitortantly.  any  bias  error  in  the  basic  Doppler 
hi'adinf;  Cjuantities  will  result  in  a  divcrttinn  ramp  ftosition  error  with  time'. 

ii)  \'LF  Navigation  For  the'  purpose's  of  the'  VLF  algorithm  designed,  six  stations  arc'  assumed 
to  be  opc'rational.  I  he  following  paramc'ters  used  in  the'  algorithm  arc  defined: 

P  :  a  known  gc'ographical  position  chosen  to  bc'  c-lose  to  the'  present  \'LF  position 

(i.e.  within  a  few  nautic'al  milcst 

P  :  the  latest  VLF  position  ■  to  be  c'ominitc'd  from  incoming  \'LF  (thase  mi'asurc'nu'nt 

data 

P|'  :  the'  microsc'cond  distance  from  P’  to  location  of  VLF  station  j  (j  -  1 . bl,  as 

calculalc'd  from  the  Soclano  invc'rsc'  routine' 

cv^'  :  th('  a/.imuth  angle  from  P'  to  loc-ation  of  VLF  station  j  (j  1 . (i),  as  calculalc'd 

from  the  .Soclano  inverse  routine' 

P|  :  the'  me'asure'd  microse'cenid  distance'  from  P  to  the  loc  ation  of  \  LF  station  j 

0|  :  the'  a/.imuth  angle  from  P  to  the'  loc'tttion  of  VLF  station  j  the  af'pieixinuit ion 

ce^  '  is  vtilid  for  the'  long  distam  e's  involve'd 

X  :  (he  increment  in  longitude'  in  going  from  P  to  P.  me'tisureel  in  microM'coiuL  ip  ■.eel 

y  :  the  increment  in  hititude  in  going  from  P  to  P.  me'iisure'd  in  micro^ec  emiL  ip  s,-.  i 


For  any  givi'ii  V  LF  sttition,  j.  the'  eepiation  e'xpri'ssing  the-  x,  y  increments  lan  be  w  nl  ten  as. 


X  •  sin  ei  V  •  cos  ei  P  P’ 

I  -  III 


■  :i  \  ■ 


Willi  six  VLF  stations  in  all,  tlic  following  si‘l  of  ohsi-rvation  (■(luations  is  availalilc  to 
l  aU  iilali'  a  solution  for  (x,  y); 


X  •  sin  0|  -  y  •  i'osa|  I’j  1’’ 
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X  •  sin  o.  V  •  I'Os  a,  =-  1’,  -  P' 

nt'fiiu'  sin  a  ;  t-osa^;  -  Pj;  tht'ii  Equation  (5.1)  hi-i  onii's. 


X 


A. 


y  • 


c 


1 


(5.5) 


A,  +  V 


liavintt  the  least  set uarcs  solution. 
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The  solution  from  E(|ualion  (5.1!)  assumes  that  e(|ual  weiyhlini;  is  plaeed  on  (he  ml'ormat urn 
from  all  six  V'EE  stations  hemi:  used.  The  position,  P  ,  that  is  useil  in  (he  ealeulalions  (re 

E(|.  (5. 1 ) )  IS  usually  the  previously  ealeiilated  V  l,K  (losition  new  V  l,F  positions  are  (  ah  u 
lated  every  ten  seconds,  so  P  is  always  fairly  close  to  P.  Note  that  the  (x,  >■  1  solution  lumi 

Equation  (  5.(!)  has  the  units  of  mierosiaoiids,  and  must  lie  converted  to  the  eipiivalent  in 
units  of  dettrees  l,.\'l',  EONtl  tiefore  the  new  P1..A1,  PEO.Ntl  can  lie  eaU  ulated  I  lien 
PLA  T  -  PEAT'  +  y;  PEONd  PEONC'  e  x. 

Doppler  A'EF  ( 'omplemeiitary  Filter  \avi(jalion  Ttie  l)o|i[iler,  headinu.  and  \'EI'  na\it;a 
tion  data  ran  he  hleiuled  to(tether  into  a  very  sim|ile  alj^oriltim  Eased  on  a  diuilal  version  of 
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st'coml-ordcr  complenu-nliiry  filli‘rinf<.  In  t‘ss(.>ni-o,  Ihf  Dopplor/iu'adiiin  data  is  only  used  for 
hitjli  rn'ciueiu  y  oontrihutions  to  position  while  the  VLK  data  is  used  for  ‘dc’  and  low  fre- 
tpieney  trai'kinft  of  position.  The  I'onipleinentary  filter  design  is  sueh  that  there  is  a 
piTfei  tly  flat  frequeney  response  in  the  filter  output.  The  hasic  .sampling  rate  for  the  digital 
version  of  eoniplemi'nlary  filtering;  is  0.1  eps  (i.e.  the  same  as  the  '/LKl  and  the  input 
quantities  used  are  VLK  position  (I’y  j  j  :  as  computed  from  the  VLK  altjorithm  just  de¬ 
fined)  and  the  so-i  alled  ten  second  Dopjiler  update,  flD  .  Actually,  two  different  sets  of 
iiqnit  quantities  are  used  PLAT^,  i  j  /HD  |  ^  j  and  PLONG^  I  |  'HD'|  ^  so  two 

difjital  I'omplementary  filters  run  in  parallel,  one  for  PLAT  and  om-  for  PLONG. 

The  UD  quantities  are  computed  by  accumulatinj;,  via  trajiczoidal  intep'ation.  the  half 
second  Dopjiler  velocity  componi'iits  over  each  t»‘n  second  VLK  sample  interval.  For  the 
ntli  ten  second  VLK  interval. 


UD,  ^  ,(j)  =  UD,  1)  +  —  •  [PLAT(j)  +  PLATlj-  1)]  ;j  =  l . 2 

;<J'  =  +  V  *  [pLONGlji  +  (PLONG(j-  1 1]  ;j=l. 


to  N  <; 


(5.7) 
.  20 


with  PLAT  and  PLONG  defined  in  Kciuation  ( 5.1 1.  Define  UD* ,  ^  n )  ”  UD|  ^|(2()l. 
UD* ,  ^  ,dn)  =  LID,  20)  as  the  Doppler  updates  to  he  used  at  the  idli  ten  second 

sample  time  in  the  complementary  filter.  The  jieneral  recursion  formula  (for  i  ither  PLA  T 
or  PLONG)  has  the  form: 


P(n;  (  (n)  =  C,  •  P,,|,  ,  (n  -  1)  +  CL  •  1\,,.  ,  (n  -  2) 


I  ‘oi  I 


o  (  I 


+  C,  '  ^1\. ,  I  (n)  +  (1  -  a)  •  1\.  I  ,  (n  1  )  -  a  •  l\  ,  ,  (n  2) 
^  •  [uD*(n)  -  UD*(n  -  2)j 


+  (' 


O.M 


with 


2  5  •  K  •  ( 1  a ) 

1  +  5  •  K 


5  •  a  •  K  1 
1  +  5  •  K 

5  •  K 
M  5  •  K 


( 5  ;)i 


c. 


0.5 

+  5  •  i; 
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'I'ho  values  of  parameters  K  and  a  are  chosen  to  define  a  particular  second-order  filter 
characteristic  that  is  reciuired.  From  experimentation  with  real  naviuation  data  it  has  hcen 
determimni  that  a  damping  ratio  of  f  =  0.707  and  a  break  frequency  of  f  =  0.008  hz  gives 
good  results  (i.e.  23"r  overshoot  and  a  90  second  st'ttling  time)  this  corresponds  to 
K  =  0.0892  and  a  =  0.69952.  Based  on  these  values  for  K  and  a,  the  coefficients  in  Kqua 
tion  (5.9)  become, 


C,  =  1.924152 


C,  =  -  0.500706 


(5,10) 


C,  =  0.299785 


(V,  -  0.959107 


'rh(>  i'om|)lementary  filtc'r  definc'd  above,  using  the  i>articular  set  of  coefficient  values 
siieeified  in  K(|uation  (5.10),  is  tlu' one  that  is  used  in  the  navigation  (  (imparison  studies. 

IV)  .\aive  Kaiman  Filter  Navigation  The  effei  tive  operation  of  the  Kalman  filter  is  highls 
(lependent  upon  having  good  a  (iriori  knowledgi'  concerning  the  nominal  operating  eondi 
tions  of  the  viu'ious  navigation  sensors.  For  exanqile.  if  oni'  sensor  di'grades  in  aeeiirac  y. 
and  that  degradation  is  deti'ctable,  then  that  information  is  useful  to  the  Kalman  filter 
it  can  lead  to  more  ai'curate  state  (>stimation  than  would  occur  if  the  ilegradation  went 
undetected.  Therefore,  two  ilifferent  Kalman  filter  implementations  are  eoiisidi  red  m  the 
com[)iU‘i.son  study.  The  first  implementation  a  so-called  naive  version  (d  the  Kalman 
filter  involves  establishing  a  set  of  nominal  initial  conditions  for  the  filter  whieh  is  held 
fixed  no  matter  what  the  actual  status  of  the  various  sen.sors  might  be.  This  version  of  ilie 
Kalman  filter  is  completely  oblivious  to  any  I'hanges  in  the  (piality  of  the  meommu  data 
Obviously,  if  .some  aspect  of  the  measured  navigation  data  i  hanges  significant  ly.  then  i  In 
filler's  performance  will  degrade  accordingly.  The  initial  condilion  spec  ifieat  ions  i  licpsi  ii 
for  the  naive  Kalman  filter  used  in  the  eompari.son  studies  are  outlined  in  I  able  .5  1 

vl  Smart  Kalman  Filler  Navigation  'This  im|>lemenlat ion  of  t he  Kalman  filter  assiunes  m me 
method  exists  for  monitoring  the  basic  reliability  of  the  mdiviilual  navigalum  scu'or-  \s 
soon  as  It  liecomes  known  that  a  particular  sensor  (e.g.  I  )op|)ler.  (12  i  c  imp.iss,  i  .r  \  1 , 1 
slationi  has  degraded,  this  information  is  used  in  tlm  Kalman  filler.  Certain  paramete  rs  ,,i 
the  I  liter  are  then  modified  to  reflect  the  new  knowic-dge  aboiit  t  he  stat  Us  1 1 1  t  he  nav  iv.ii  II II I 
sensors.  1 1  tel  u  dec  I  m  t  his  version  of  the  Kalman  filter  is  the  ea|iabilil  v  of  fix  inc  .cnv  pari  ii 
tilar  T  iiialrix  diagonal  element  at  a  high  value  for  accurate  \'  I  ,T  I  uas  drift  cst  im.ci  u  m  i  ir , 
simply,  very  ra|)id  V  I ,  F  bias  esi  i  mat  lent ,  The'  majorit  y  of  t  he  mil  lal  cc  uidil  ic  ui  s|  in  1 1  n  .u  h  u  i 
tor  I  111'  smart  Kalman  filter  will  be  the  same  as  I  hose'  for  the  naiv  e  Kalman  filler  i  .i-  di  I  ini  1 1 
111  I  a  bill  5.1  ).  except  w  here  noted  for  the  (cart  icular  condit  loii'  mi  tin-  clal  a  I  icmi.:  used  u  i 
the  comparison  st  iidy . 
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I'ABLK  5.1 

INITIAL  CONDITIONS  FOR  NAIVF  KALMAN  KILILlv 


Position;  FLAT  , /FLONG  ,  15.001 /75.(K)1  lii'U 

Bia.s  in  Doppler  tfroutul.spoiKl ;  0,0  knot 

Bias  in  true  track:  B  0,0  de^ 

l »  fcH  > 

Biases  in  VLF’  |ihas(“  m(>;usurenients:  B,  ^  ^  (i  =  1 . 0)  0.0  p  see;  all  i 

Noise  variance  for  V|, ;  (j’ ^  —  l.Oknof 

Noi.se  variances  for  a,  jj;  o'  ,  o'  .  0.25.  0,25  detp 

Noise  variance's  for  VLF  stations:  o'  ,,  (i  =  1 . <>)  1 .0  p  see"  .  all  i 

Error  covariance  matrix :  1’ 

-  t* 

Variance  of  lU.AT,,.  FLONG,, ;  1),B„C2,  21  0.0001.0.0001  de>>- 

Variance  of  B,  :  F  (3,  3j  --  10.0  knot' 

Variance  of  B  F^,(  I,  M  '  5.()dei;' 

Variances  id'  B,  ^  :  F  (5,  5)  -  F  p  10.  lOl  0.1  p  sec-  ;  .d'  i 


5.2  Description  <ff  the  Different  Types  of  Simulated  Navigation  Data 

The  four  ilifferent  types  of  simulaUxl  navigation  data  to  he  eonsidered  are; 

I)  best  ipiahty  elata. 

II)  ilata  with  large  Dop[iler/hcaeling  bias  errors 

III)  data  with  large  VLF  phitse  bias  errors,  aiul 

IV)  data  involving  VLF  station  drifts. 

Two  different  aircraft  trajectories  are  u.sed  in  the  simulation  studies,  namely. 

a)  straight -line  track  with  constant  velocity  and 
I))  circular  track  with  constant  tangential  velocity. 
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Detailed  speeifieations  on  the  various  types  ot  simulated  data  are  as  follows: 
i)  Best  Quality  Data  -  The  conditions  simulated  for  the  navitjation  transducers  are; 

a)  Doppler  radar  system  — 

-  1.0  knot,  n'^.  =  l.Oknol’ 

B^  =  0.5  de^,  fj-  =  0.25  de)j- 

b)  C-12  compass  system  — 

B^  =  0.5  det-,  (j-  =  0.25  deg- 

c)  VLF  system  —  stations  used  are  O  G  M  A  D  W 

B  .^i  =  0.1  p  sec,  0"  .  ^  =  1.0  p  sec’ ;  i  =  1,  .  .  .  ,  0 

ii)  Lar^e  Doppler/Hi'adinn  Bias  Errors  -  The  conditions  simulated  for  the  navittation  trans¬ 
ducers  are; 

a)  Doppler  radar  system  - 

By  =  10.0  knot,  =  10.0  knot’ 

B  ^  -  5,0  deg,  =  2.5  deg- 

b)  (M2  compass  system 

B  =  5.0  deg.  n  -  2.5d<'g' 

e)  V EF  system  speeifu  ations  same  as  m  i). 
lii)  Large  VLF  Phase  Bias  firrors 

a  I  Doppler  radar  sy  sleii ,  spei  il  ieat  ions  .^ame  as  m  i ). 

b)  (’- 1  2  compass  syslem  speeifie.il u uis  same  as  in  it. 

et  VLF  system  -.pei  i fical ions  same  as  in  u  l^vee/)/ 

B  ,  10.0  p  see,  ir  2.5,0  p  see  for  \’LF  stations  O  and  or  (i. 

IV)  VLF  Station  Drifting 

a)  l)oppler  rtidar  system  spec  dieations  same  as  m  ;). 

b)  ( '■  1  2  (  I impiiss  system  spi-c  ifieat ions  same  as  m  i). 

I  I  V  L !•'  system  s pee d'leat ions  same  as  m  i )  e.x  c  I’/if 

B  changes  linearly  at  1  0.0 /i  s,s  hour;  o’  .5,0  ;j  si-,  fed  \LF  -tat  Ion 

( )  or ( i . 


I 


Information  ootucrnint;  the  two  (iifft'rcnt  aircraft  trajectories  simulated  is  as  follows: 

a)  Straight-Line  Trai  k,  C'onstant  Velocity  ■ 

Initial  Position  15.0'  LA']’,  75.0  LON'd 

Error  in  As.sumecl  Initial  Position  0.001  L.A’l  ,  0.00 1  LO.Nd 

(Iroundsiiei'd  250  knots 

True  Head  inti  15.0 

h)  Cireular  Track,  Constant  Tantiential  Velocity  'This  type  of  aircraft  trajcciui  s  is  u'-i  ful 
for  simulatintJ  a  slronji  acceleration  situation  for  the  aircraft.  .Note,  however,  that  ihi-- 
jiarticular  manoeuvrine  would  never  (iccur  for  any  leiittth  of  time  under  normal  flymc 
conditions. 

Initial  Position  15.0'  LAT,  75.0^  LON'd 
’Tangential  \'elocity  250  knots,  clockwise 
Radius  of  Circular  'Track  10.0  nm 

Centripetal  ,\cci‘leration  2.i).'{  ft 'sec^  orl.TM.'iknoi  see 
5. .'5  liosults  from  Simulatint'  Rest  (Quality  Data 

Simulation  runs  were  conducted  usinn  the  hest  t|Uahty  navittation  data  on  the  five  dilTi  rent 
naviuation  schemes  heintt  compared.  Both  the  strait;ht-lin<'  and  circular  tracks  were  considered  :e  well. 
In  the  case  of  the  straiyht-l ine.  constant  velocity  trajectory  there  was  no  difference  hetweeii  the  naive 
and  smart  versions  of  the  Ktilman  filter,  so  only  one  of  them  was  used.  Fivture  20  i  ompares  the  lotal 
position  erriirs  for  each  navigation  al{>orithm  as  a  function  of  time,  over  .i  5000  see  run  iNU'l  Iv,  total 

position  error  [(  L.A'T  TlKRtJRl'  +  (LONG  KliRORc]  '  ■  I.  From  Fiyure  20  it  can  he  seen  ili.ii 
nav  i|ia;  me  on  ( lopfiler  headine  .iloiie.  even  with  reasomihly  pood  Doppler  iieadin.u  data,  result  -  in  .i 
Sian  if  lean  I  ramp  ty  pe  o  f  posit  ion  error  d  iw  to  the  biases  m  around  speed  .md  lie.-e  1  me ,  .\a\  lyat  my  o:  i 
\'  LF  stai  ioii.s  alone  leads  to  a  hounded  error  with  t  ime  the  ern  ir  lew  1  slejvvn  here  lot  \'LF  wo  mil 
correspond  to  ,i  very  eood  pualtt  v'  \'Ll'  sit  iiat  ion.  When  the  Doppler  \  1 ,  F  >  oinplemeni  .irv  I  'll  ei  is 
Used  ( i.e  C(  )MPL  in  Fiy.  20 1  ihe  averaee  error  level  deci'isises  slight K  .  ami  tin  le  i-,  a  i'll  "l  a  .mo,  ,t  1 1 e !.. 
effect  on  I  he  \’LF  error  from  tin  lovv  -pass  ai  t  ion  of  tin'  filler.  'The  hot  torn  trace  m  I  ,"_i  m  2”  hm.v  - 
the  Kalin.in  fill  er  result  clearly  much  sU|ierior  to  any  of  t  he  ot  her  u.iv  lea’  '.on  s.  !>.,  ui'  ■  .■  i  '  ■  i  e  ■  < ' 
aver.iee  error  level  and  sinooi  hness  o  f  error  la  ■-  ponse.  Not  lee  t  h,.  t  v  pa  al  Kalman  01'  ''re  a..  ,c  'a  a,  h  <  ■ 
ri  suit  s  111  a  slmlit  !v  liicher  error  d  unne  the  first  few  inindred  set  ond'  ol  'la  i  'in  .i  -  I  n,  f':: .  i  .I'l.u  '  ■  ; .  ■ 
the  III'  ommu  dal  a. 

Fie  lire  2  I  shows  similar  results,  ana  in  for  the  hest  oualit  \  data,  wine.  ' ,  ,  ,  e  ';  '.u  '  ’  i.  vv  ' 
e.  >1  isl  ant  t  aiu'cnt  lal  veloeit  \  |s  heiii'c  siniulal ••d  |u  this  ease,  hoth  a  ua iv ■  and  ,i  inai ;  ,  i  " .  '1  ' ' 

K.il  man  III  l  er  ate  .on  'idered  in  the  comparison  |i|ot  '|'he  error  hehav  lom  -  for  1 1 I  n  .  i  ,i  . 

V  L  I'  aloni  .  am  I  I  top  pier  \'  I .  f  '  omph'nniilai  \  filler  eases  are  .iImiui  vv  hal  w  '  e  ild  ; .  ■  i  •  ,  '  ■  .  i  i  I  I,  .i  ,|  ■ 

error  i  -  eonsi  r.iii  n-'  1  he.  aii'e  oi  t  h.  ■  cm  ular  I  raie.  i .  u'v  ) :  hu!  t  he  toi p.  .s.;  .on  en ,  e-  o], .  ■  ■  ■  i  ,  i , 

K.il  mai  I  fill  er  e-  i  ,i|  her  mt  eiv  .l  me  For  1  h.it  .'.ise,  1 1,.'  po-il  n  m  err,  a  .n  t  u.div  m,  i  ■  .i  ■  w  "  e  '  i  m  ' 

r.il  i  n  r  sieii  1 1 1 .  .Ill  I  level  it  even  l<  lok  s  a  s  1 1 1,  iiiei  1  the  i-rror  e-  sp  ,  vv  I  \  d  i  v  e|s  ,e  m  w  1 1  n  t  ,  1 1 ..  i  •  : 

for  this  h.  conies  .ippann!  when  one  i  oiisider.s  the  i  \  pi-  o  I  .iirer.il  i  1 1  ,i|ei  ; ,  u  \  1 1  i.e  i  •  . '  a  in ,  ..i.e  ■  . 

Rei  al  I  I  h.ll  the  .Iin  uial  ei  I  e  ire  111.  I  r  I  r:n  k  result  s  m  a  .  oust  .ml  eeui  l  ipiU  ,il  n  ,  ejel  .u  |,  ,;  1  ,1  I,  ,  p  .. 

or  1  7 .!.  I  k  not  s  ..ei  foi  1 1  le  ,i  m  raft  I  h  is  is  a  fairlv  sipmfn  an!  .n  e.  !e|  .ii  n  e.  lev  •  i  ,1  .  I  '  ;  ;  ,  1 

hi  ad  me  pl.in  I  .  Ii.i.sei  I  oil  V  eloi  It  y  measiiremeui  s.  vvill  in  It  lie  111  .irlv  .1  .n,  111. it.  .1  mil,,  ii.e.ii  l,m 
.  ousi ani  veloeil  V  l  a.se.  Neverl  heless.  t In-  naive  v  1  rsioii  ol  the  K.ihii.ii  1  I ih ei  .1 , ■  i 'i ; '  .  1  1  ,  p,. 
head  I  lie  plant  ret  aiiis  U  >  minimal  aieiirary  as  defined  hv  t  he  noise  V  .Ui.u.,  ■  i  e.  1  ■.  ..1  . . 

. ' ,  ,1  in  I  e  I  I  c.  m  I  .ihie  , )  1  I  {  )l  IV  lousiy .  I  hese  spei  I  I  leal  n  ills  are  nil  oi  I .  I  I  t .  a  1 1  ■■  '  .  p'  ■  '  i-  .  >  "  i ,  1 1 . 1  i 

111'  .1  ion  I  ,ik  me  1  'lai  e  am  1  a  mart  version  ol  t  in  K  .ihn.in  I  lit  er  1 1 ,1  I  .e.  >  ,  1 ,  .  .  i  ■  \ ,  1 .  ,  ■  h . 

or.  ililem 


to 


For  till'  smart  Kalman  rillcr  a  [lour  t|uality  plant  is  assnim'd.  and  this  mli  nimit  am  is  .  .in 
VfVfd  ti)  tlu'  I'lltcr  liy  rcspi'city  mt;  n  ^  100.0  kimf  .o’  115,0  di'^  ,  and  n  115  <1  di-a 

'riicsf  clian^ti's  m  initial  iDiulitiiiiis  uivc  a  much  ln-ttiT,  and  iiniri'  st:il)|.',  tutal  |ii)sHi(/n  ■■nur  |.|w: 

(  shiiuii  111  till'  l)(  ittiim  t  rat  I'  of  Kii^.  2 1  I.  'I'liis  posit  ion  orror  traco  shows  a  si'aml  uaiit  in  .  ro  \ .  in.  i  a 
I'omfiart'd  to  all  the  others,  hut  the  improvement  is  not  a.--  ilraniat n  as  m  the  >I rai^ht  1  me  1 1 .iji-.  i,  .i ., 
ease  (shown  m  Ki^.  20).  The  reason  for  this  is  the  I'aet  that  the  hasii  plant  update  ,  (pi. n  n  ni'  liaw 
deteriorated  m  aeeuraey  I'or  the  eireular  tiatek  situation,  and  the  Kalman  filter  i  .miiol  he  .  \p.  ,  i,  .( 
do  as  well  under  the  (  ireumstanees.  Specafyinr;  hasie  plant  act  iirac  y  as  a  luin  lion  id  tin  '  \  p.  d 
aireralt  trajeetory  taking  place  is  only  one  of  the  eapahihties  that  a  smart  K.ilman  lilii  rmu'!  ii.ii,.  .i 
will  hi' shown  suhsecpiently . 

5.1  Results  from  Sinuilalin(>  Laiyje  I  toppler/iieaiiiii^  Riascs 


'file  simulation  results  from  navigation  data  with  larne  lloppler  heading  hi.i  ■  n.’i  ■  .u.  d 
(ilayed  m  Kittures  22  :md  25.  Figure  22  compares  the  five  different  navip.ilion  s,  h.  nn  '  I  'l  tie 
slraiuht-line  trank  etise.  For  navipal ion  «  it h  I foppler  .done,  the  erri ir  hmld  n  / .  diji'  i .  >  ].ir_i  I ).  i; i 
heading;  hiases  is  (piite  dramatic.  Navipati  m  error  results  for  \'1.F  .done  sl.i\  Ihi  s.im,  j.  h. d  .i.  .  i 
the  navieation  errors  for  the  Doppler  \'1,F  eoinpleinent ar\  filter  I  lie  i,iri;i'  I  lopp!.  i  i  .-.til  .  .  'i  i 
errors  do  not  afleet  the  oi'erat  nm  id’  the  com  (dement  .iry  filter  hi  cause  onh  tie  Inal .  h .  .  |  le  ■  .  . 

tnhui  ion  from  t  he  Dopider  lieadiny  system  Is  Used .  I  he  naive  and  sm.irt  vii'iin.'id  !:•  Km  ,i:  ! 
produce  ahout  the  same  error  lev  el  in  the  st  eadv  slate,  and  hot  h  are  ,i  oani  In  .mi  impi  > '  v .  ii  i.  :  d  .  v . 
the  other  navii'ation  alttori thins.  I'he  only  diflereiiee  in  the  error  icsp, ;  (i,  i  u  . .  c  r- s  n , 
Kttlman  filler  is  that  the  iraiisieiil  res| loiise  for  the  first  dpt)  sic  or  so  i-  .i  lot  t.i-t.  )  ,i m  le  ■  • 

smart  version,  'fit is  is  due  to  the  fact  that ,  for  the  smart  version  of  t la  I ih.  i .  mil  i.d  .  ..t id  ;  m  e  . 

res|)ee:fied  as  ir  ^  1  0 .( 1  k not  ,  d'  2.5  riei;-  .  ()■  2.5  dei;  .  I'  Id,  di  loiMikioi  .ii,  l 

(’,((.  D  .'lO.Odee-  to  take  .'idvaiilaf.’e  of  tile  ;i  jiriori  kiiowledi.''  lli.il  I  )oppl' r  headnn  hi.i  I',  a  , 
slun  il  leant  (so  t  hat  a  faster  tidiiisient  res)  loiisi-  should  In-  used  when  isi  nn.it  ina  tin  mi 


Flu  lire  2.'!  eomptires  I  lie  five  luiviuatioil  iduorit  hills  (,  n-  tin  ,  ns  iilai  1 1  .n  k  ^.t  n.d  io:  I  \.  '  I  • 

eiTi ir  result s  for  I )o|i|iler  alone.  \' I .F  .done,  and  the  1  )o|>|)|er  \  I.F  .  ompleiin  nt .n  v  i ih .  r  -in. w  :  ■ .  i .  . 

siir(irises.  Ill  sjiite  of  (he  laree  l>)|)pler  headinu  hia.se.s.  errors  in  |)o|ipler  onlv  n.ivju.ilioii  i.  m  m 
reasonahly  hounded  mainly  heeaiise  of  l  lie  10  nm  radius  <  ireiil.ir  1 1  .lek  o;  h.  rvv  ise .  tin  D'.npi.  i 
naviuation  error  would  urow  at  a  much  faster  rate.  The  naive  .iiid  smart  K.dm.in  Idiei  re-ull  -  .n.  v  i  . 
similar  to  those  shown  in  Fiunre  21  tie.  for  best  (piality  data  and  ;i  (  iia  iil.ir  1 1  .n  k  l  lie  m  .nm  i.k  v. 
Kalman  lilter  s|ieeifieat  loiis  on  the  1  )o|ipler. headinu  plant  lorrespond  to  ,i  |.l.int  upd.ii.  .  .pi.iiim 

.issumed  hy  the  filt  er  to  he  more  aee  urate  than  is  real  I  v  the  (  ase  .\s  .,  .'onse.  (Ueiiei  ,  tin.  ( .. .  ■  it  i. .: .  .  ri  'i 

urows  with  I  line  m  fact ,  the  Kahii.ui  filter  ap|iears  |(>  l>|.  close  to  iiisi  ahiht  v  M  .dil  n  d  ,  p  |,  . 

on  t he  (dan I  for  the  smart  Kalman  filter  ( t  he  same  ones  as  for  the  hcst  (pi.dit  v  d ,it  ,i  .  n .  ul.n  1 1  .i.  k 
1  ase  I  reetily  the  situation  hy  iiiere.isinu  the  level  ot  (daiit  noise  .issumed.  whi.h  li.o  ,i  - 1  ,il  nl  i .  n  i: 
ill  ( liieiii  c  on  the  lilter  res|  loiise.  Note  that  the  smart  Kalman  I  liter  eri'i  if  res|  .oiisi  is  .  .i  1 1  v  .i  m  .n ,  1 1 1,.  I 
imiiroveiiieiit  over  thill  of  the  eoni)  dement  ary  filter  ;i|i|)ro,ieh  due.  no  douhl .  t . .  tin  |  .....i  .  pi.ii  it  \ 
(daiii  u(idatmu  for  the  eireular  maiioeuvrmu. 

For  eonijdeteness.  Fiuure  2  1  shows  (ilots  of  the  aelmil  l)o|i|i|er  In  .idinu  l'‘;is  .  rrois  m 
at  I  cm  I  it  mu  I"  estimate  If^  and  B  iisiiiu  the  Kalman  filter.  The  runs  used  i  orresp,  md  i. .  tin  n  nilt 
from  Fiuure  22  for  larue  l)o|)|der 'headinu  I'lases  with  a  str;nuhl  line  triu  k  Fiunre  2  1  indn  ates  th.ii 
the  error  res|ioiise  IS  much  faster  for  the  smart  K.ilman  filler  eom|i;ired  to  the  naivi  version,  du'  i.. 
the  ehanue  in  initial  conditions.  Nevertheless,  for  holh  mnve  ;iiid  simirl  versions  o|  the  filter  tin  .  rr..i 
111  estimalmu  the  hiru''  I)o|)|der/headmu  biases  are  (piite  smiill.  'I'he  same  small  bias  error  level-  o.  .  in 
even  when  the  eireular  t  riiek  manoeuvre  is  used  m  the  simuhit  ion  runs.  ,\n  ohv  loiis  (irac  l  n  al  sm  uat  ion 
m  which  l)o|i|der/headmu  huises  become  siumfieanl  oeeiirs  when  maunel  n  van, it  ion,  \  A  IT  n  sp...  died 
ineorreetly  the  Kidman  filter  will  ((iiiekly  estimate  ;my  obvious  bias  in  o  *  p  from  this  sour.  .  ol 


error 
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5.5  Kesults  from  Simulating;  Large  V'LF  Station  Uiases 

Siimilution  result.s  for  navigation  data  involving  large  l)ia.ses  in  eertain  \'LF  station  plia.se 
ineasnrenients  are  eoinpared  in  Figure  ‘25  (for  the  straight  line  trajeetory ),  wuli  VLF  stations  ()  and  ('■ 
simulated  to  have  phase  biases  of  10  p  see  eaeh.  The  effect  of  these  two  V'LF  biases  is  iiuite  evident 
for  the  V'LF  alone  and  Doppler/VLF  eomplementary  filter  runs.  In  both  ea.ses,  an  average  total  posi 
tioii  error  of  1 .0  nm  occurs  because  of  the  significant  biases  in  the  two  V'LF  stalion.s.  .\ote  that  the 
(  oinplenientary  filter  still  tends  to  smooth  out  tiu'  V'LF  data,  but  it  can  do  nothing  about  the  V'LF 
bias  errors.  On  the  other  Inuid,  both  versions  of  the  Kalman  filter  show  position  error  improvement 
vs  ith  lime,  rile  naive  Kalman  filti’r  response  is  quite  sluggish  beeau.se  of  tlie  nominal  initial  condition 
v.u'ianee  levels  for  all  V'LF  bias  estimates,  u-  ^  ^  0.1  /a  see- ,  all  i.  However,  with  appro|>riatelN'  large 
milial  condition  variaiiee  levels  for  biases  in  V'LF  station  O  aiul  ('■  (i.e.  u-  “  100. 0  p  see-  ).  as 

defined  for  the  smart  Kalman  filter,  the  speed  of  response  of  the  error-versiis-t line  plot  is  greatlv 
eiihaneed,  and  the  steady  state  total  position  error  is  (piite  low. 

.Vs  a  further  cheek,  navigation  data  for  the  straight  line  trajeelorv'  was  simulated  with  botli 
huge  Doppler  heading  biases  and  large  V'1,F  bia.ses  m  stations  ( )  and  (L  This  was  done  in  order  to 
verifv  that  the  siqierimposed  data  response  was  essentially  the  same  as  the  sum  of  the  mdividu.il 
K.ilin.iii  filter  responses.  With  the  V'LF  bias  errors  predominating,  the  output  error  response  for  the 
-iipi  riinposed  data  was  virtiiallv  identical  to  that  shown  m  Figure  2.5  (the  oiilv,'  exeeption  being 
1  top p ha  oiiK  n.iv  igat ion  \\  here,  of  course,  the  large  Doppler  heading  bias  I’rrors  ilo inmate I.  !•  igiiie- 
2(i  .iiid  27  show  the  complete  set  of  Kalman  filter  error  responses  for  each  of  the  naive  and  smart 
\  er'ioiis  of  the  filter  eorrespoiuhng  to  this  su  pi  ■run  posed  navigat  a  /ii  ilala  sit  uat  loii.  Fro  in  t  i  le  n.iiv  e 
K.ilni,iii  filter  error  outputs  of  Figure  2(1  it  <  an  be  seen  ih.it  the  Doppler  heading  biases  are  estimated 
pin  kl y  and  .u  eiirateiy ,  while  V  LF  bias  estnnat ion  is  miieb  more  sluggisli ,  i'bere  is  .hso  an  ol i  \  lous 
jileraei  loll  among  v.irious  V  I.F  stations  as  a  resull  of  tlie  linear  dependencies  t  hat  are  known  to  exist 
( )i :  tin  other  hand ,  the  smart  K.iim.m  filter  error  out [lui s  (Fig.  27  i  look  gi >od  righi  across  the  board 
the  advantage  of  hav  ing  accurate  a  prion  knowledge,  especially  i  oiieerning  VLF.  is  i  pi  it  e  ev  ideiit ' 

a.ti  Mesults  from  Simulating  VLF  Station  Drift 

Sun  iilated  nav  igat  ion  data  with  V  LF  ’  at  ion  t )  drift  mg  .it  the  i  .ite  ol'  10  p  see  hour  was  used 
tor  tin  com  par  I  SI  III  plots  of  total  posit  ion  error  shown  m  l•'lgure  2.S.  I  he  effect  ol  the  constant  VLF 
drill  rate  n  ,  learlv  si'eii  in  the  VLF  and  eoiniiU'ineniary  filler  plots,  ,V  n.nve  version  of  the  Kalman 
tiller  pi'oi  hiei  s  an  output  error  w  h  k  h  appears  to  stabili/e  at  .i  level  of  about  O.d  nin ,  I  low  ever,  a 
I  ifopi  rl V  progr.ii tuned  sin.irt  K.ilmaii  filli  r  ( i.e.  with  l’(  .5,  .51  I i\ed  at  1  00.0  p  see  for  the  cut  ire  run  i 
results  in  a  vi'i'v  sin, ill  total  position  error,  as  shown  in  the  bottom  traee  of  f  igure  2S  Similar  results 
oil  111'  if  VLF  si  at  Ion  ( i  is  d  ri  ft  mg  instead  of  st  .it  ion  ( ).  Figure  20  shows  tin  ,  oinplet  e  set  o  I  est  nii.itjon 
errors  for  the  naive  K  .ihn.in  filter  run  with  VLF  stat  ion  (  )  drift  mg.  The  assoeiat  ed  V  I ,  f  bias  error  plots 
1  lid  ie.it  e  t  h.it  t  here  is  .1  si  rong  III  ter  act  ion  .imong  the  v.irioiis  V  l.f  bi.is  est  miates  e.uised  by  the  dri  ft  ing 
ot  '1  ,it  Ion  (  )  fig  lire  do  d  ispl.iy  s  the  s.une  error  ((Uant  it  les.  but  for  the  sm.irt  K.ilni.in  I  ilt  er  east  .  Not  lee 
liow  the  VLF  bias  errors  are  mm  h  more  stable  .mil  bardh  drift  .it  .ill  i  omp.ired  to  the  n.nve  K.ihn.in 
tiller  (  ase  ,\ote  also  that  tlie  )  iroeedlire  of  fix  ing  !’(  5.  .5  I  ,ll  I  00,0  p  se.  me.uis  1  h.lt  the  I  i.lsle  noise 
proi  ess  of  V  1  .  !■  st  at  loll  <  )  (  (I  '  .5  O  P  see  '  (  Is  pres. -I  it  III  t  III  -  •■'I  nil  It  loll  .ITol  of  u  I  ll  Us,  I  he 

norm.il  sill,  lot  h iiig  el  feet  of  tile  f. ursioii  (ormiil.i  lor  .  st  mi.il  mg  It  i  f.q  i . 1 1 1  i ■  I >\  p.esed  .  .  .uisn ig 
b  to  I II  i-st  ini.iteii  III  .1  noisy  fashion  ,  -hist  t  im  s.mie.  tin  .iver.ig.  ■  ■  i  o  u  m  >  -  t  iiu.u  mg  b  is  .  los.'  to 
zero  III  spit.'  Ill  III.'  larg.'  drilt  rat.-  bi’iiig  siuiiilali’il. 

5.7  l{esulls  from  I  sing  Ifeal  Data 

,\bi  ml  .in  hour's  w  i  irl  h  of  real  n.iv  ig.il n ui  il.il .i,  i  oll.-i  t.'d  i  inbo.ir.l  I  h.'  (  onv  air  .b.MI  res.'aii  h 
.nri  rdt,  h.e  be.  n  analy/.'d  using  (In'  van. ms  n.ivig.it  nm  .ilg.  ini  h  in  -  .iln.iily  .1.  fiii.'il  lie.  Doppli't 
in  .11 1  ing  nav  ig.it  ion  .  V  I  ,F  navigat  Ion .  1).  ippl.'r  VLF  .  ompl.  meni  ar\  I  ill.  r  n.iv  ig.it  nm.  n.nve  anil  smart 
K.iim.in  lilt  er  n.ivigators  |,  'I  h.'  navigat  ion  .  hit  ,i  w  ,is  .  olleeti'.l  in  tin-  v  n  nut  y  ot  (  It  t  awa ,  and  tlu'  I  y  l'.' 
of  ,iiri  ra  ft  I  ra|.’.  tory  iiivolv.'. I  vv  as  a  sern-s  of  ra.  et  r.n  k  p.il  t.  nis  p.issnig  ov.  r  w  .11  k  now  n  visual  Ian.  I 
marks  sinii  ,is  .iirp.  .rt  I  n  n  oils.  airp.  irt  V(  )l(, '  ■  .iinl  run  w.i  v  mtirs.-i  t  nuis  I  h.'se  v  isu.il  on  t  ops  .ui- 


.  Ill  riuirM'.  in  uriiri  tn  liavc  pinntN  for  cNlalili^liinu  ^avl^;aUn^  crrnr  as  a  fuiu  Imn  nl 

t  imc  in  llif  l  aM'  nl'  the  rral  data.  Tahlc  fi.Li  shows  a  list  of  tlio  visual  on-tops  in  Ilif  sf(|ui'iu  i  m  u  hu  ll 
ihi'V  wiTi-  o\crflown,  toiicthi'r  with  tlu'  tiinu  and  vorrcot  t;i'ot;raphii'al  loi  ation.  Notn  that  tin-  an  iirar\ 
of  ilu'S"  on  tops  Is  IVlt  to  he  within  0.10  iini,  Thu  tahlc  iiiiluatcs  that  then-  arc  ahout  57  iiiinutcs  id 
iiscalilc  navigation  data  from  the  known  start  position  to  the  final  on-top. 
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INKOK.M.VnoN  ON  IHK  VlSl’  Al.  KKI  KKKNf  K  POIM  S  K01{  l  lli:  \A\  lO.X  I  ION  SH 

I’ypc  of  Oil-Top  Time  from  Start  ( leofjraphieal  l.ocatjon 


Intersection  RVV  2.5-22 

0  secs 

15 

IS'57  ' 

TT) 

20  55 

Ottawa  \ OR 

2;)0  sees 

15 

2b  20' 

TTa 

52  50 

Kinburn  Meacon 

.5  HI  secs 

15 

25  00 

7t> 

OS  5S 

•Arnitrior  Hridite 

1  1.20  -sei  s 

15 

2b  Ob) 

21  00 

Kinburn  Re;icon 

1.210  secs 

15 

25  00 

7C) 

OS  5S 

Oitawa  VOR 

1520  secs 

15 

2b'20  ' 

7  f) 

52 '50 

Intersection  RW  25-22 

1  700  sees 

15 

1  S  57' 

7  r> 

2'.)  55 

1  I'lantls  IRnwon 

10, so  secs 

15 

12  15  ' 

7  T) 

20  :ib 

1  phinds  Heacon 

22  10  SCI  s 

15 

1215' 

7 .7 

20  .'ib 

Ottawii  ffciicon 

2700  secs 

15 

21  .'ib" 

7  5 

.'i2'  11 

Intersection  RW  25  .22 

2t)7 1 )  s< ‘cs 

15 

1  S  5  7 

7r> 

:>t)  5.5 

Rideaii-Carleton  Raci 'track 

.21.20  secs 

15 

1  7'  is" 

75 

2b  15 

Ottawa  Heacon 

.2  1 1  2  secs 

15 

21':. b" 

75 

:{2'  1 1 

Kor  the  part leular  navi^at ion  data  collected ,  the  \' l.K  slat lo ns  a^ ailalilc  were  1 \1 ,  1 ),  ( ,  W  . 
and  R.  Kiitiire  dl  shows  the  relative  locations  of  these  \'I,K  stations  iisini:  a  I.amlicrl  pro|niion 
centred  at  Ottawa.  It  can  he  seen  from  this  projection  that  <he  VI, K  i;eonicir\  is  not  the  h.-st.  wilii 
many  of  the  stilt  ions  almost  in  line.  The  possibility  of  V  l,K  linear  dependencies  will  i  lien  i  h  -  ipi  iti  i  'mI. 
and  this  fiict  must  be  taken  ttito  account  when  tisini;  the  Kalman  filter  approach  \'I.l-  eroimdriin 
stiitistics.  based  on  12  siimples  for  each  station,  were  coini'iited  by  monitoring  the  \  I.F  ii  ccm  i  jii'-t 
[irior  to  the  ii.'ivitjation  flirtht .  .As  well,  a  comp;irison  of  l he  riiw  \'  I.F  w iis  m.idc  I u  i  im-i  n  the  si ,irl  i  ini- 
data  and  the  V  I.F  ihitii  at  the  21)70  sec  point  ( hot  h  of  t  licsc  |io  sit  ions  are  the  R  \\  2.5  .!2  ml  cisci  i  u  a.  i 
I  o  see  whet  her  or  not  iiny  \T.F  bias  driftint;  wiis  t  ak  mi;  |ilace.  The  results  con  h  I  then  I  ic  i  om  pai  >  1 1  with 
the  est imates  of  V LF  bias  arrived  at  by  usinu  the  Kalman  filter.  I'he  muse  \  ariaiice  cst  mi.ilc.  and  i ,iw 
V  I.F  data  compiiri.sons  ;ire  displayed  m  Table  o.'i.  From  I  Ins  table  it  can  be  seen  th.it  tin  \  I ,  f  eioiind 
run  noise  variances  differ  widely  from  one  station  to  the  next,  but  all  are  well  below  the  nonim.ii 
1  .0  JJ  sec-  level .  The  VT.F  phase  bi;is  shifts  ( i.e.  .’  p  sec  l,  based  on  V  I  ,F  measurement  s  t  aki  n  ,il  h  ml  ,5n 
minutes  ajiart ,  are  all  fairly  small  except  for  the  bias  shift  of  V I  .F  slat  ion  R  .\  closer  look  .it  si  ,it  mn 
R 's  phase  readini;s  reveals  that  a  fixed  drift  rate  of  ;ibout  1  7.0  p  sec  hour  exist s,  ,ipparenl  ly  dm  to 
macciiriicies  m  the  freijuetu'y  of  transmission.  It  was  felt  that  it  would  be  an  idisil  lest  for  the  K.ilm.in 
filter  to  try  to  track  the  known  drift ini;  V  I.F  stat  ion.  I'his  part  icular  real  \'  I  ,F  data  w  as  considered  to 
be  quite  represent  ill  ive  of  wind  lo  expect  in  the  way  of  I  y  pical  \'  I,  F  dat  a  diiriim  the  coiirsi'  of  a  I'l  lyh  I 
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VI.FSTAriON  INFORMATION  FOR  TUF  NAVIOAI'ION  SIT’DV 


Station 

Grouiulrun  V'arianee 

Phase  Measurement 
at  T  =  0  See 

Pliasr-  .Measurement 
at  1'  =  2970  Sec 

.'.  p  Sec 

L 

0.012  p  sec- 

9850.5  p  sec 

9852.5  p  see 

2.0 

.M 

0.005  p  sec" 

3601.1  p  sec 

3000.0  p  sec 

1.4 

D 

0.1  Od  p  sec- 

4138.9  p  sec 

IMO.O  p  sec 

1.1 

G 

0.093  p  sec- 

210  1.1  p  .sec 

2103. 4  p  sec 

0.7 

W 

0.01 1  p  sec- 

6230.0  p  sec 

0230. t)  p  sec 

0.3 

R 

0, 01  1  p  sec 

()783.5  p  sec 

0797.1)  p  sec 

14.1 

I  ABLL  5,1 


RK  \1,  DATA  INi  riAL  CONUITIONS  FOR  THF  NAIVK  KA1..MAN  FII.TKR 


I’osition:  f'L.AT  'FIXING  ,  - 
Bias  ill  Doppler  Grouiulspccd :  - 

Bia.s  in  true  track :  B  ,  ' 

Biases  in  VLF  phase  measurenients:  B  ^  (i  1 . •>) 

.Noise  variance  for  V| m  ;  (c  ^ 

.Noise  variances  for  (I  p’:  ir  hr 
Noise  variances  for  VI, F  stations:  c 
Frror  covariaiu'e  inatri.x.  I’ 

Variances  of  I’L.M'  f’l.ONG  :  1’  (  1  ,  1  l  1’  (2.  X1 
Variance  of  B^  :  I’  (.'i.  .'ti 
V  ariance  of  B  .1’  (1.1) 

Variances  of  B  ^  I’  (.'i,.')l  •  1“  (In,  DM 


15.B15S  Tn.BBriX  det; 

0.1)  knot 
0,0  dep 
0.0  p  see;  all  I 

I  .0  knot  ‘ 
d.."i,2..5  deji' 

as  per  Tahlc 

II  IMIUI  II  lliml  dir 
mo  II  knol 

mo  o  dep 
O  I  I  1  p  ■'Cl  ,  ,il  1  i 


11 


'I'ahk'  5.1  iiiilii-alcs  the  initial  condition  siH'cil'ication.s  for  a  naive  version  of  tlie  Kalman 
filter  that  was  run  usin^  the  real  navigation  data.  Specification  of  VLF  noisi'  variances  based  upon 
^roundrun  measurements  was  felt  to  he  quite  valid,  even  for  the  naive  Kalman  filter,  since  these 
measurements  can  he  ai'complisheti  quite  simply  before  the  start  of  any  navittation  (littht.  .Moreove  r. 

noise  variances  for  o,  (j  namely  u'  ,  i)“  ,  -  were  specifu'd  as  2.5  di-tt”  each,  based  on  eexaminmn  llm 
raw  Doppler 'heading  tlala  a^ain,  something  that  would  normally  be  available'.  I'hi'  vanam  e's  on 
and  B  were  set  cpiite  hifth  in  order  to  estimate  any  Doppler/headinn  biasi's  very  (|uie  kl\ 

1  loweve'r,  the  variances  on  all  the  B  ^  's  wen-  set  fairly  low  to  avoid  a  st  ronji  interactieni  anunm  \'  I.!- 
bias  estimates  be'cause  of  the  linear  dependencies  known  to  exist.  Figure  52  shows  tlie'  Kalman  fille  r 
outtnits  basee.!  on  llu'  specifii-ations  ilefined  in  Table  5.1.  In  Figure  .'ill,  the  associati'd  position  e-rrors 
are  tlisplayed,  biLSe'd  on  the  13  visual  fixe's  available  diirinn  thi'  eours.'  of  the  fliirhl.  It  can  be-  se  e'n  rieem 
these  |io.sition  e'rror  plots  that  the'  overall  error  is  fairly  small  for  over  half  the  flitthl  and  the  n  it  'tart- 
to  increase.  The  inerettsintt  error  is  felt  to  be  due  to  the  effei  t  of  \'l,F  station  K's  elnftine  e  vemt iialK  . 
the  (iluLse  drifliiiit  bi'^jins  to  effect  the'  Kalman  filti'r  accuracy.  Judeiim  from  the  \’LF  plub-i'  bia> 
est  i  mates  m  Fieuri'  32,  the  filter  is  tilli'mptinft  to  follow  the  drift  i  lift  in  st  at  ion  R  but  j  list  cannot  keep 
up.  The  information  from  Table  5.3  suftftesls  that  estimation  of  the  \'LF  biases  in  L  and  .\!  i-  at  lea.'l 
proceedina  in  the  rifthl  ilirectlon.  I  lowever,  the  other  \T.F  bias  estimates  appear  to  bi'  mei  irrect  ;  :■  > 
doubt  the  linear  dependency  [iroblein  is  mtinifeslmt:  itself.  In  shtirp  eontrast,  Fmuie  32  'liows  tliat  ti,' 
Dopph'i'  heading;  bias  estimates  are  resolved  rtilher  ipiiekly  .iiul  then  remain  at  reason, ii)l>  eoii-'an: 
values. 


In  order  to  alleviate  the  detrimental  effect  of  \T,F  st  at  um  K  drift  mu.  a  'inart  Kalmai;  ;  .in  i 
was  desianed  specifically  to  track  station  R's  shifting;  bias.  .\s  widl.  this  version  of  t  he  KahiMii  !  ;i'  ■  i 
concentrated  on  estimatinu  the  two  lareest  \'LF  biases  (as  di'lerinmeti  from  Table  5..'!  i.  naim  l  \  .  ; •  ,  *  ■ 
of  \'  LF  stations  I,  and  M.  I'he  char.ftes  t  bat  were  made  to  the  initial  eondilions  m  order  to  del  na  ■ : . 
smart  Kalman  filter  tire  outlined  m  Table  5.5.  Note  that  the  error  eovarianee  diagonal  ■  leii'a  i  :  ■ 

Cl  irrespondinu  to  \'LF  Inas  est  i mates  in  statiotis  D.  f  I.  tiiid  B'  (i.e.  I’  (7.  7  /  •  I'  t  b.  !•  1 1  .ii  i  'ei  :  r 

/ero.  which  tneans  tlnit  \'  l,F  bias  est  mial  ion  is  not  even  beme  till  emitted  for  these  part  leiilar  t.i;  an  - 
f'luiii'e  3  I  displtiys  the  v  ai  lous  smart  Kalmtin  filter  estimates  as  ;i  funetion  of  t  ime  w  bile  Fiuuii  .  l.h 
shows  the  result iiift  position  errors  ,it  the  13  visual  cheek- points.  From  Fiuure  3  I  n  can  be  set  : i  1 1 i.n 
the  smart  version  of  the  Kiilman  filter  is  traekme  the  drift  m  station  R's  bias  ipiiie  aeeiiratelv  i  le,  .lil 
that  thedrtft  rtite  is  ,ibout  17  sec  bouiT.  Moreover,  bias  estimation  for  \T.F  stat  loii'  Land  .M 
appears  to  be  proceed  mu  m  the  riuht  direct  ,on.  Tbe  results  in  Fiuure  35  md  leate  t  hat  the  |  sis  n  ion  ,  n ,  ,| 
increases  somewhat  durmu  the  initial,  transient  reuion  of  Kalman  fillerinu  action  and  then  .ippeais 
settle  down  quite  nicely .  as  ex  pel  ted  for  proper  ope  ml  ion  of  t  he  Kalman  filler.  .\oi  u  e  t  iial .  laii  . 

I  ioppler  headmu  bias  est  imat  ion  is  almost  id  ei  it  leal  to  I  hat  of  1  he  naive  fill  er  ease,  file  rat  i  ler  'ii  i.il  i 
1  )op|  iler  head  mu  b  lasi's  est  limited  suuuest  t  hat  the  Doppler  head  mu  dead  reek  on  mu  na\  luat  ion  s.\  -  i'  n , 

Is  reasonably  aecurtite  for  this  parlieiilar  fliubt  data. 
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A  lompansoii  study  was  roiutui'trd,  for  thu  saiiic  si't  of  ri-al  iiavitialii )ii  data.  mMiUiup  the 
varidus  |>i)ssil)l(‘  riaviftatioii  altiiu'ithms  (i.c.  Dopfilcr  aloriu,  \'i,F  aidin',  aiul  Doppli  r  \  Id''  i  i irnplriiici i 
lary  liltrr  as  well  as  tlic  diftiTciU  vursioas  of  the  Kalman  I'llu-rl.  d'hi-  n-sul[^>  dI  this  >iiidy  arc 
suniman/.cd  in  the  conipanson  plots  sliown  m  Fifturi'  .')(>.  N’avipalion  Li.-nit;  Doppler  alone  i>  siirpro- 
in^ly  aeeurale,  with  the  total  position  error  rismt;  to  a  little  over  ‘J.d  nm  .d’ter  one  hour.  .Most  likeK  . 
the  position  errors  would  have  heen  hip'her  for  Doppler  only  naviualion  if  a  straiithi-lme  airer.iii 
trajectory  hail  heen  Lised  instead  of  the  raeetraek  patterns  that  were  flown  ri'call  Iroin  the  Simula 
tion  studies  how  the  Dop|)ler  iieadmjj  errors  tended  to  he  hounded  for  the  eirciilar  track  casi'.  The 
.--econd  plot  in  Fienre  .'ill  show.■^  Doppler,  \'LF  eomplenieiitarv  filter  position  error  results  \'hF  alon 
is  not  sliown  hecausc  the  results  are  virtually  ideiitieal  to  those  id  the  .  ompleiuentar\  filter,  file  total 

I  losii  ion  error  ot  the  complementary  filter  ri.ses  to  almost  'd.d  nm  after  one  liour  duc,  no  douhi ,  to 
the  various  \  l.f  hiases  and,  ol  course,  the  eonstant  drill  rale  ol  \’I.F  'talion  K.  fhe  naive  Kalman 
tiller  and  smart  Kalman  I  liter  ( i.e.  .SM.\  K'l'  K  F 1  )  results  refer  to  the  versions  of  the  Kalman  filler 
described  earlier  m  this  section.  From  Fijture  ;>(>  it  can  he  seen  that  the  Kalmaii  filter  appro, u  h 
certainly  imiiroves  the  overall  posuional  error  very  siemfieantU  . 

rile  results  of  one  other  Kalman  filter  run  tire  displayed  a.s  the  bottom  trace  iii  Fieiire  .'hi 

I I  e.  SM  .\K  1  K  Fd  i.  F.\  per  I  men  I  at  ton  revealed  i  his  to  he  'he  most  aeeurale  result  at  l  ainahic:  .ind  t  lie 
p.irlh  ular  initial  conduions  that  produce  this  result  are  rather  interestme.  For  this  case,  all  eiior  co- 
V  .inanci'  diaaon.ils  I'eiat  :ne  to  \'  LF  bias  est  i mat  ton  were  set  to  /i-ro  i.e,  no  \d.F  hia-  e^i  imai  ion  win 

ikinu  pi. ice'  ,\ll  other  initial  conditions  on  tlie  filter  were  the  same  as  for  tim  ’N'.MX f  KF'  .md 
■SM,\K  f  Kl-  r  case'.  Norin.ilK’.  vv  it  h  no  \'  1  ,F  hitis  esliinat  ton  takinr;  place.  .ni  v  siniii  I  lean  I  hia-  i  m ;  Id  u 
in  the  \  l.f  ph.ise  measurement '  w  ould  affect  the  aecuraey  id  the  filt  er  out  put  s.  I  low  ever,  ac.  .  ad  ms. 

’  o  the  \  I ,  F  bias  'hilts  mdicali  d  in  Table  'K-i.  the  const  ant  drift  rat''  of  \'  I .  F  'titlion  K  is  1 1  m  on  1 1,  ■ ,  ae 
'hilt  o|  aiiv  real  coMseiiueiice.  Furthermore,  the  aronndrun  noise  variance  for  K  is  ahiiormaliv 
'  oinp.ired  to  the  Ollier  \  I,  F  'tat  ton  noise  variances  nnore  than  two  orders  of  inaanit  ude  coin;  ..,red  ■  o 
t  inil  o  I  st.it  II  111  Ml,  so  the  Kalman  filter  has  a  st  rone  teiidenev  to  'w  eiuht  out '  the  in  fl  u.'in  e  of  \'  |  d' 
'tation  K  ill  the  overall  position  estimate.  <)n  this  htisis.  the  Kiilman  filter  position  estimate  i  ,iii  he 
liiiiie  .1C  cur  ate  w  uhout  e,  ant;  to  the  extent  of  VLF  bias  estimation.  ,\'  ;i  matter  of  fact,  allow  in  s.  tin 
Kalman  lilter  to  estimate  \'1.F  bitises  probably  introduces  an  additiomil  const  rami  and  coinplexitv 
■'.inch  tends  to  decrease  the  aci  ur;iey  of  posit  Ion  est  1  mill  ion  in  this  ease  the  known  linear  de  pen 
' In n l  ies  .inioiic  \  1,1'  bias  est i mates  also  eonu-  into  plav  here.  Of  eourse.  the  sit uat ton  would  proh.i! >1  v 
i  le  ,1  I'd  ill  I  lereii  t  if  V  cry  sittnificant  biases  h;id  developed  in  one  or  more  of  the  eril  ical  \'  I ,  F 't  at  loH' 

I  hen  \'  I.F  hi, Is  est  1  mat  ion  would  come  into  its  own,  as  demonstriiled  in  tile  si  mu  la  t  ion  results. 

a  .H  .'summary  of  |{esults 

The  major  results  from  the  comparison  study  are  the  foltowmu'. 

Dead  reckomni;  naviaation  usinu  the  Doppler  headinjt  system  is  ipiite  sensitive  to  biases, 
even  to  fairlv  small  ones,  especially  for  the  tvpieal  straight  dine  tracks  that  are  flow  n  .\n  v 
Dop)i|er  head  me  bias  errors  will  result  m  a  position  error  which  du  erees  with  time. 

.\av  mation  usiiii!  an  .iveraee  of  all  \  Id'’  information  is  somewhat  sensitive  to  \'1,T  bi.is  shdis 
.111(1  other  \  Id-  .mom.ilii's  that  mvanalily  oeeur.  Fortumilely,  these  errors  usuallv  result  m 
.1  bounded  posit  ion  error  as  a  fiinet  ii  n  id’  I  ime,  except  for  the  drift  inp  \  I  ,F  station  condi 
1 1<  in . 

I  he  Doppler  \  I,  F  complement  ary  filter  is  completely  immune  to  Doppler  head  mn  bi.ises 
and  has  a  weak  tendency  to  ’smooth  out'  the  \  I.F  position  I'Stiinales  as  wa  II  as  I"  redm a 
the  error  sllphliy.  However,  the  eomiilemimtary  filter  reslioiise  is  still  affected  bv  \  I.F  biasi 
and  stilt  ion  drift  mi;. 

I  he  Kalman  I  lit  er  has  a  ver\  st  ronu  sinoothim;  act  ion  on  the  posit  ion  erri  ir  and  it  i  an  In 
ext  remely  i  nsensil  ive  to  both  Doppler  head  mi;  and  \  I.F  biases,  depend  mp  upon  the  i  m  1  lal 
( onditions  i  hoseii.  The  smart  version  of  the  Kalman  filler  is  always  found  to  be  siimificani  l\ 
su|)erior  to  the  complementary  filter  approach. 
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()ul|nil  rrrors  t'rciin  ;i  naivr  version  of  llic  Kalman  filter  can  lie  a  lot  lai'tter  than  llio-.e  from  a 
I'inart  version.  The  naive  Kalman  filtiT  navigator  a[)|iears  to  lie  especially  sensitive  to  iiiilial 
ciiiulition  specification.s  re^tardine  the  ((Uality  of  the  plant  and  the  status  of  the  \anou.s  N  IJ- 
stations  lii'in^t  used, 

file  Kalman  filter  navittator  has  demonstrated  its  accuracy  when  applied  to  type  ah  real 
na\  lyation  data  even  to  the  c.Kteiit  of  heinc  aole  to  track  a  real,  drifline  \’Id-'  station. 

ti.O  fONC'l  I  .SIO.NS 

‘i.l  .\ssessment  of  the  Kalman  Filter  .Xpproaeh  to  .Naviftation 

I  he  Doppler  A'LF  Kalman  filter  studied  m  this  report  has  sh.ou  n  tlm  man\'  advantaites  of 
tills  type  of  approach  to  tlie  navigation  task.  I'rohahly  onc‘  o!'  the  mam  advantages  tiie  Kalman  lilier 
•  ipp  roach  oi  I  els  is  lle.\iliility  in  t  erms  o|  handlinu  reduiuhmt  nav  ijral  ion  m  format  ion  in  so  mi  optimal 
! .isii Ion ,  \  anous  naviyai am  t r.insdncer.s  can  he  modelled  into  the  Kalman  filter  foi  mat  fairlv  readilv 
.md.  hence,  can  he  used  to  their  full  potential.  The  Kalman  filter  is  also  very  flexible  when  it  come- 
to  ii.indline  tile  raw  dtita  from  any  ajven  navitfation  i  on fiyurat ion  -  m  particular,  tiie  very  iiasu  traiis. 
diicer  relationships  can  he  modelled,  il  so  desired.  .\  priori  knowledge  concerning;  tile  ijualitv'  ami 
I' aative  accuracy  ol  the  wirious  navisfation  t r.an.sduceis  lam  he  put  to  nood  use  hv  the  Kalman  filler 
w  iiiiess.  I'specially.  the  results  ohtained  when  aiiemptinu  to  irai  k  \'1.F  huises  and  hias  dnf's.  Ti,' 
l)o|)pler  \  I.F  Kalman  filter  has  cert  am  i\  demonstrated  tile  lu'iiefits  to  he  earned  from  mode!  lev.  and 
est  1  mat  nut  d  1 1 1  ci'en  i  bias  error  i|  utmi  it  ics.  and  it  htis  a  No  shown  nisi  I  lovv  simple  i  lie  moi  h  d  i  in  st  e  ■  i  ma- 
tion  process  can  become,  ,\  bonus  to  iie  uained  Irum  es’imatine  Dopph'r  In-aihntt  biases  U'ma  li.e 
K. liman  liller  is  the  tact  that  impn.'Ved  estimates  of  ilu-  mrea-aft  v.-loei'v  •  ompoiieiit'  ear:  men  oe 
'omptited  ,  Tile  eonecfit  of  eo  imat  mit  I  hi’  various  error  ■.  niani  it  les  of  t  m  -  o\  erall  me,  ivai  a  m  sy'i  I’l;.  m 
re..n  time  mipl  les  that,  sin  m  Id  i  aa  p.iia  o  l  die  system  !  .nl  at  sc  inie  poji  i  i  in  time.  n.c\  mat  io  e  ni  n  r.ic  'c 
’cVhl  I'lot  lie  sevefeiv  Jeopard  ilo 'c ; . 
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siimilalion  work  or  cxiu'rimi'nls  jiwolvinn  real  VLF  data.  .V-,  can  be  seen  I'roin  the  results 
pre.sented  in  this  report,  pro|)er  Itaiullinn  of  the  raw  VLF  data.  esi)eeially  durintt  the  varion.^ 
■;inoinalous'  sitlitilions  tluit  I'an  arise,  is  critical  to  tlie  successful  opertition  of  the  IJoppler 
\  LF  Kalman  Liter.  .Mui'h  has  ln'en  learned  about  VLF  iihase  bias  estimation,  the  associated 
linear  ilependeneies  which  can  occur,  and  the-  possibility  of  bias  drift  estimation.  Neverlhe 
less,  a  ttreat  di'al  more  work  can  and  should  b<-  done  in  this  area. 

ii)  Real  1  line  I’rottrammmu  I’roblems  A  delinite  challenge  will  be  the  ih  sipn  ami  implemeii 
tation  of  a  real  time  version  ot  the  Doppler,  \’LF  Kalman  filter  lor  use  onboard  the  Convair 
research  aircraft .  .\lthoueh  the  Kalman  filter  simulation  routine  doe.>  a  aonil  |ob  of  pro. 
cessing;  the  real  (lata  acejuired  Irotn  the  Convair  navijfalion  transducers,  this  is  a  far  c  rv  liom 
simulatme  a  ri  al  time  ooeration  onboard  the  atreraft.  The  major  prolileni  w  ill  be  eoiivefsioii 
of  the  Kalman  filler  simulation  routines  (  written  in  FORTH. \.\'  I and  opeiat intf .  at 
present,  in  the  IB.M  .'UkiB  I'SS  environment  |  to  the  Interdala  7  HI!  mmieomptiii  r  onboard 
the  Convair.  .\t  the  heart  ol  the  problem  will  be  t he  computal ional  speed  and  accuraev 
recpiired  to  propayate  the  Kalman  Liter  matri.x  recursion  eijuatioiis  One  meaii'  of  rediieinu 
the  com|uitalional  burden  mipht  be  to  lenpthen  the  update  interval  from  ten  sec  laaU  to. 
sa\-.  twenty  or  ihirtv'  seconds.  ."Simulation  studies  could  be  done  to  determine  the  .'flcci  a 
lontti'r  update  interval  mip'ht  luive  on  basic  estimation  ticeiiracy.  The  costs  of  siimilation 
runs  in  the  1  SS  env  ironmeiu  are  expensive  lor  the  ten  .second  updat e  case  as  it  stands  now 
I'  or  exam  pie.  it  cost  s  about  .Sot),  and  t  tikes  1 00  .seconds  ( d  (  I’l  time  for  one  Kalman  1 1  It .  r 
run  usinn  the  hour's  worth  cd'  real  naviuation  data. 

nil  Ntivittaiion  S.vstem  .Auymeiuation  Kveniually.  other  navittatiou  transducers  avtiilabli  ui 
the  Convair  will  be  included  m  an  auymenled  version  <d'  the  nav  luai  ion  filter  dest  ribed  in 
this  repoL-  I’l'''  imxt  naviualion  aid  to  be  included  will  probabK  be  i!i,.  Litton  l.l  N-.'il 
inertial  iiaviaalion  system  two  dil  lereiit  tipproaches  could  be  Used  to  jiitep’rate  tin  L'l  .\  I 
inlormalion  into  an  expande<l  model.  The  simpler  tipproach  would  mvolvi  treatiiii;  tin 
mertitti  nav  latiior  as  a  'black  box'  and  usme  its  position  and  velocity  outputs  as  additiomu 
measurements  the  Kalman  filter  pltint  would  slay  the  same  as  Indore  1 1.(.,  tii,.  |  l.ipj  i,  r 
he.idina  update  eiiuatioiisl.  .\  more  complex  tipproach  to  the  problem  would  havi  the 
iiic'rlial  system  as  the  basic  plant  model;  l)op|iler.  headine.  and  \  LI'  would  'lien  lie  leil  .e 
dan  I  measurement  c  plant  it  n-s.  I  h|s  appn  >aeh  w  ould  imply  havinu  tn  cess  to  ;  i b.isu  lerti.n 
I  p  i  a  n  I  i  I  les  ( d  the  L  I  N  -  •>  1  sy  si  el  11  1 1  .e .  1 II  leaf  aeeelei'at  ic  nts  and  an  vu  la  r  rat  ■  s  o  i  el  lai  i  at  i .  .  \ 
simulation  study  comparing  the  two  approac  hes  would  help  to  determine  vvinc'n  is  tia  mini 
effective  direction  to  take-  in  usiiiit  the  Litton  datii. 
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FIG,  3:  BLOCK  DIAGRAM  OF  KALMAN  NAVIGATION  FILTER  SIMULATOR 


NN  =  NN  +10 


CALCUL  Al  K 
DOPPLER  IMEO. 


ra-riNE  2. 

AND  g. 
MATR ! CKS 


DlKINI-:  ij 

i  I 

1  CA‘CU!AI>:  1' 
j  Ul^DAIlO  i 
;  rsTiyAUS  ii 
•  Al  I'ME  NN  M 


[ 


I  Kl.ND  IPlJE  I 
j  (’001  11  ON  ! 

I  AT  nwi.  tin 

‘  --i-  : 

Df  n  Nt'  H 

1  : 

MND  L 

NwiiAir  ' 

1  vn  M(  AN.  ■ 

il  (VIE  Sif,')  ; 


:i  o. 


IN  If  PM  INI 
():>)!  M'  !M 
I  jPDAl  t  D 
rO  II  MATI  N 


Di  f  INE  P  I 


r 


PROGRAM  RUN 
IDE  Nil  I  ItTAllOEl 


/ 


/  READ  initial 
INPUr  IM+O. 


7 


/ 


] 


/ 


/ 


LCMO  'NPLir  / 


'' . I  -  ^ 

1 


I  CO^Vfi^T  UM.f?  I 

'  Ki^uT  TO 


OfMf  Mt  D  VAi  ; 


i 


N!  iia: 

fi. 


E'A’  R  .  IN  N 

I 

i 


NIA'M  ^•■A^';OM’ 
MJVH;  R 
l,t  --A'  ' 


•  i  J. 

(L: 


iirif’- 


&  P 
MA’ 

■  I 


» 


/  V.'-’I 

+  r-  >. 

M '.’  V 


/ 


FI(k4  FLOWCHAfU  OF  KAIMAN  f  1L  \[  H  SIMULATOI^ 


FIG  5  KALMAN  FILTER  OUTPUT  ERRORS  FOR  SMALL  INITIAL  ERROR  VARIANCES 


FIG.  7;  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  INITIAL  ERROR  VARIANCES 
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FIG.  8;  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  SMALL  P, 
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FIG.  9;  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  MEDIUM  P„ 
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FIG.  10;  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  LARGE  P. 


-  61  - 


V 

•iin 


ft: 
c  J 
ft: 
fK 
[.  1 

C"? 

(  5 
] 

f  < 

a ; 
.  1 


..I, 


(>  K.i 

r  a 


ir. 

«  C  5 


n: 

o 

O- 

rr 


Pi 


g! 

<5 

R 

[, 

i 


I  • 

: ') 
c  J 

I  ■ 

( > 


ri: 

lij 
,  j 

n. 

ri. 

o 

C ') 


h::hh:) 


?Ncn 


f):in 


^  rjn.TA 


FIG.  11;  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  INITIAL  BIAS  ERROR  VARIANCES 

NO  VLF  BIASES  SIMULATED  IN  DATA 


FIG.  12:  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  INITIAL  BIAS  ERROR  VARIANCES 
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FIG,  13:  STABILIZATION  OF  P  AND  K  MATRICES  WITH  TIME  FOR  LARGE  P, 
AND  DAVIS  STRAIT  LOCATION 
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FIG  16  KALMAN  FILTER  RUN  WITH  FOUR  OUT  OF  SIX  VLF  BIASES 
BEING  ESTIMATED  FROM  POOR  INITIAL  CONDITIONS 
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KALMAN  FILTER  OUTPUT  ERRORS  -  TWO  DRIFTING  VLF  STATIONS 
WITH  APPROPRIATE  Pn  ELEMENTS  FIXED 
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FIG  22:  COMPARISON  OF  TOTAL  POSITION  ERRORS  USING  DATA 
WITH  LARGE  DOPPLER  BIASES 
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FIG.  24:  DOPPLER  BIAS  ERROR  PLOTS 
LARGE  DOPPLER/HEADIIMG  BIASES  SIMULATED 


lacn.o 


2000.0 


3000.0 


4000.0 


TIME  IN  SECONDS 


FIG.  25:  COMPARISON  OF  TOTAL  POSITION  ERRORS  USING  DATA 
WITH  LARGE  VLF  BIASES 


NAIVE  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  DOPPLER/HEADING  BIASES  AND  LARGE  VLF  BIASES 
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FIG.  27;  SMART  KALMAN  FILTER  OUTPUT  ERRORS  FOR  LARGE  DOPPLER/HEADING  BIASES  AND  LARGE  VLF  BIASES 
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FIG  28:  COMPARISON  OF  TOTAL  POSITION  ERRORS  USING  (TATA 
WITH  A  LARGF  VI  F  DRIFT 
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FIG  35  POSITION  EF^RORS  FOR  SMART  KALMAN  FILTER  RUN 
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.\PPEND1X  A 

ALGORITHM  FOR  HANDLING  DOPPLER  BEAM  FREQUENCY  DATA 


The  raw  Doppler  data  consists  of  three  Rf'  beam  frequencies  each  sampled  at  a  tw'ic('  |)er 
second  rate.  The  beam  frequencies  -  f  ^ ,  f|^ ,  f ,  —  are  defined  as  follows: 

f^:  starboard  forward-looking  beam  frequency; 
f|^ ;  port  forward-looking  beam  frequency; 
f^  :  port  backward-looking  beam  frequency. 

The  components  of  velocity  in  each  of  the  three  body-fixed  aircraft  axis  directions  (i.e,  u.  forward; 
v;  starboard;  w;  vertical)  can  then  be  expressed  as 

u  =  [{f,,  +  50000)  -  (f  +  50000)] /8.925;  (knots) 

V  =  [(f^+  50000)  -  (f|,  +  50000)] /■L4625;  (knc'.i  (,\1) 

■  50000]  /20.576;  (knots) 


To  convert  tlu'  velocities  u.  v.  and  w  into  a  straight-and-level  co-ordinate  system  (x.  : 

X  (lositive  forward,  y  ■  positive  to  starboturd,  z  -  positive  local  vertically  iqnvard)  one  must  use  the 
pitch  (())  and  roll  (0)  aircraft  attitude  information.  Assuming  0  is  positive  for  i.ose-up  attitude  and  o 
is  po.ative  for  right-wing-down  attitude,  the  three  straight-and-level  components  of  Doppler  velocity 
liecon- 


=  cos  d  •  u  +  sin  0  •  sin  0  •  v  +  sin  d  •  cos  0  '  w 

=  cos  0  •  v  -  sin  0  •  w  i.\2l 

“  sin  0  •  u  -  cos  0  •  sin  0  •  v  -  cos  0  ■  cos  q  •  \\ 


The  groundspeed  (V|  j,|,)  and  drift  arifle  (o)  (luantities,  more  useful  in  llie  Dopi  Icr  ii.ivic.i 
tion  model,  are  then  exjiressed  as 


V 


1)0  1* 


( knots) 


I  A.) 


I 


o  arclan  ( );  (radians) 
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APPENDIX  B 


VLF  COMMUNICATIONS  STATION  INFORMATION 


Letter 

Designation 

Call  Sign 

Location 

Frequency 

(KHz) 

Radiated  Power  (kw) 
Nominal  Authorized 

M 

NAA 

CUTLER,  MAINE 

17.80 

890 

1000 

W 

NLK 

JIM  CREEK,  WASH. 

18.60 

250 

1000 

L 

NPM 

HAWAII 

23.40 

140  -630 

1000 

S 

NWC 

NORTH  WEST  CAPE, 
AUSTRALIA 

22.30 

1260 

1000 

R 

GQD 

VNTHORNE,  G.BR. 

19.00 

- 

— 

G 

GBR 

RUGBY,  G.BR. 

16.00 

250 

300 

J 

NDT 

YOSAMI,  JAPAN 

17.40 

125 

500 

O 

JXN 

HELGELAND,  NORWAY 

16.40 

150 

350 

A 

NSS 

ANNAPOLIS,  MARYLAND 

21.40 

500+ 

1000 

D* 

— 

LAMORE,  N.D. 

13.10 

9-10 

10 

D  is  actually  an  OMEGA  station  whose  side  frequency  is  being  used  in  a  VLF  mode  of  operation. 


APPENDIX  C 


DEVELOPMENT  OF  PLANT  NOISE  EQUATIONS 


It  is  assumed  that  the  zero  mean,  random  noise  processes  Uy ,  ,  and  occur  in  the  meas¬ 
urement  of  a,  and  (3  respectively  —  the  noise  processes  are  also  assumed  to  have  constant 

variances  Oy  ■ ,  ,  and  respectively.  The  measured  quantities  (V(jy  p,  a,  /3)  can  then  be  written 

as  follows; 


a  =  a.,,  -p  B  +  u 

1  r  Or  a 


(Cl) 


-  ^Tr  *  ^0  ^ 


where  each  measurement  consists  of  the  true  value  +  bias  +  random  noise.  It  is  then  necessary  to 
express  PLAT(t)  and  PLONG(t)  as  functions  of  the  noise  processes  to  see  how  these  noise  processes 
are  propagated  through  the  basic  Doppler  differential  equations.  The  continuous-time  Doppler  equa¬ 
tions  can  be  written  as 


PLAT(t) 


(Vi)OP  -  By  -  Uy)  •  cos(Q-Pi3-  B,,  -  -  u,  -  u^) 

60 


PLONG(t) 


-(Vi)OP  -  By  -  Uy)  •  sin(a  -p^-  B^  -  B^  -  u^  -  u^) 
60  *  cos  (PLAT  •  7r/180) 


(C2) 


For  simplification, define  V  =  V,,,,,,  -  B., ,  B  =  B  +  B,,u  ,  =  u  u,,o  =  a  ’ 

^  ’  o  DC)  I’  V’a#i  a  ii’aji  q  a 

-t-  o^- ,  («  +  =  a  (J  -  B^^.  Then  Equation  (C2)  becomes 


PLAT(t) 


^  “v) 


60 


•  cos  [(a  +  -  u^J 


(C3) 


-  (Vq  -  »v)  •  sin[(a^,  -  u„J 


PLONG(t)  = 


60  •  cos  (PLAT  •  7r/180) 


-94- 


If  Equation  (C3)  is  expanded,  the  result  is 

PLAT(t)  =  ^  •  [cos  (a  +  -coslu^j,)  +  sin  («  +  (?) ,  -sinlu  ^)J 


[cos(a  +  ;3)^^  -ooslu^^)  +  sin  (u  +  (?)_^  -sinlu 


-  V , 

PLONG(t)  = - ^ 


[sin  (a  +  (3)^_  •  cos  (u^^)  -  cos  (a  +  (3)^,  •  sin  (u_^^  )] 
60  •  cos  (PLAT  •  7r/180) 


(Cl) 


Uy  -[sinlft+Zil  ^  -  008(0^^)  -  cos  (Q +  (?)__  -sinlu^^^)] 
60  •  cos  (PLAT  •  TT/ISO) 


The  small  angle  approximation  applied  to  Uy  and  u^^  implies  that 

1  r 

PLAT(t)  =  —  •  •  cos  (a  +  (3)_^  +  u^  ^  •  sin  (a  +  (3)^_  -  Uy  •  cos  (o  +  (3)  ^ 


-  Uy  •  u^y  •  sin  (0- + /3)„] 


(C5) 


PLONG(t)  = 


•  sin  (a  +  (?)_^  +  '  V„  *  cos  (a  +  (3)„  +  Uy  •  sin  (a  +  /?),, 

60  •  cos  (PLAT  ’  7T/180) 


-  Uy  •  >  cos(a^/3)„ 

60  •  cos  (PLAT  *  71/180) 


In  Equation  (C5),  the  noise  cross  term,  Uy  •  u^^^,  can  be  eliminated  because  u^,  and  u  _  ,  are  assumed 
to  be  uncorrelated,  implying  that  Uy  •  u^^  will  have  only  a  seond  order  effect  at  most.  With  this 
approximation,  the  equivalent  noise  processes  in  PLAT  and  PLONG,  u,  ^  j  and  Uj  ^ respectively, 
can  be  expressed  as 
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'l,  A  1 


-  U, 


60 


a0 


*  COS  (a  +  fl)  -t-  -  •  V  •  sin  (a  +  B) 

'  gQ  O  '  *^'0 


‘LO  N  (; 


|iiy  •  sin  (a  +  (3)^  * 

60  •  cos  (PLAT  •  77/180) 


(C6) 


and  the  corresponding  variances  of  these  noise  processes  would  be 


I  A  I 


V  1  .  0(7 


^  u  p 

—  •  cos-(a  +  /3)^^  + - ‘  ■  sin-(a  j3)„ 

(60)-  (60)- 


1  O  N  (i 


[o^,-  •  sin-(a-t-/3)^  +  *  V_,-  •  cos’ (a  +  (3)^, J 

[60  •  cos  (PLAT  •  77/180)]- 


(C7) 


The  equivalent  noise  processes  for  the  continuous-time  Doppler  system  of  Equation  (C2) 
have  just  been  defined.  However,  in  order  to  calculate  the  G  needed  in  the  Kalman  filter  implemen¬ 
tation,  it  is  necessary  to  look  at  the  sampled-data  version  of  the  Doppler  state  equations.  Including 
noise  processes,  these  equations  can  be  written  as  follows: 


PLAT,,^!  ”  PLAT^  +  (Al^  “  A3,^  '^Vk^  *  ’®Vk^  ’ 


^  60 


j  '  k  *  "* 

/  -  Bvk)  • 


1 

60 


■k  ^ 


/  u^,  •  cos(rt +  (3-  ,J.  )dt 


(('8) 


PLONG^,,  =  PLONG^ 


[(Al^  A;1^  ^  )  •  eos  (B.,  )  +  ( A\  •  B^  A‘2^ )  •  sin(B_  )] 

cos(PLAl\  •  77/180) 


'k  * 


I  ■cos((»+j[J  B^  .^ldt  +  J  u^  •  sin  (d  •*  d 


L  'k 


60  •  co.s(PLAT^  •  77/180) 


where 
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^  ^  •sin(a  +  /3)dt 


'k  *  '« 


A2,  =  — 


60 


•k  "  "> 


f  V,joP  ' 

'k 


(C9) 


A3,  = 


1 

60 


•k  ^  '« 


/  sin  (a  +  0)dt 


2 

60 


•k  "  '« 


A4.  =  — —  •  /  cos  (a  +  P)dt 


As  a  simplification,  assume  average  values  for  V,jQp,  a,  and  /J  over  the  integration  interval 
(i.e.  for  the  noise  terms  only)  by  using  their  values  at  t  =  t,^  +5.  Furthermore,  define  new  random 
noise  processes,  u*  ^  and  Uy ,  as  follows; 


■^o(Jk 


"Vk 


tk  +  1  0 

f  = 


'k  "  '0 

/  Uydt 


•k  ^  '0 

/  (u^+u^)dt 


(CIO) 


With  these  changes,  the  discrete  Doppler  equations  become 


PLAT,^,  =  PLAT^  +  (Al^  -  A3^  •  By^)  •  sm(B^^^)  +  (A2^  -  A4^  •  By^)  •  cos(B„,„) 


‘k  +  l 


+  •  <0k  a6,  •  u;^ 


(Cll) 


PLONG^^,  =  PLONG^ 


[(Aik  -  A3^  •  By  J  'cos(B„g^)  +  (A4^  •  By^  -  A2^)  •  sin(B^^^)] 


cos  (PLATjj  •  TT/ISO) 


+  A7, 


a  0k 


+  A8, 


'Vk 
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where 


A5v  -  — 
^  60 


•  <Voop  -  ®vk)  •  sin  (a +  0  -  B  J 


‘k  "  5 


A6, 


k  =  ^'^os(a  +  p  - 


•k  ♦  5 


(C12) 


A7 


k 


(Vpop  -  •  cos{oc  +  fi  - 

60  •  cos  (PLAT^  •  TT/ISO) 


5 


A8 


k 


sin(a  +  <3  -  B^^^) 

60  •  cos  (PLATj.  •  7r/180) 


'k 


+  5 


In  jpite  of  the  fact  that  the  continuous  noise  processes,  u^^j  and  Uy  ,  are  assumed  to  have 

constant  variances  and  zero  means,  the  corresponding  discrete-time  noise  processes  do  not  necessarily 
have  to  have  these  characteristics,  mainly  because  of  the  coloration  effect  that  the  integration  process 

will  have  on  the  noise.  Nevertheless,  for  the  purposes  of  the  Kalman  filter  implementation,  u’^j. 

and  Uy  ^  will  be  assumed  to  have  the  constant  variances  —  o*^*  and  Oy  ‘  respectively  —  where 

and  Oy  ^  will  be  chosen  to  have  about  the  same  order  of  magnitude  as  ^  ’  and  Oy  ’ . 

From  the  foregoing  developments,  the  discrete  plant  noise  process  can  be  identified  as 

^k  =  [<k  <ok]  (C13) 


having  the  auto-covariance  matrix , 


9k 


(C14) 


I' 
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APPENDIX  D 

EVALUATION  OF  ad<^i/dPLAT;  ad(>i/dPLONG 

Recall  that  the  general  observation  equation  for  expressing  VLF  station  phase  difference 
measurements  is 

0i^  =  d0i(PLAT^,PLONG^)  +  i=l . 6  (Dl) 

Now  d(/)i  represents  the  relationship  between  a  specified  (PLAT,  PLONG)  geographical  position  and 
the  theoretical  phase  difference  of  VLF  station  i  (PLAT,  PLONG  in  units  of  geographical  degrees  and 
d^i  in  units  of  microseconds).  It  is  impossible  to  express  d^i  explicitly;  however,  each  d(p\  is  readily 
calculated  from  computer  algorithms  that  can  generate  theoretical  VLF  station  phases  for  any 
specified  geographical  location  via  the  Sodano  inverse  routine  (Refs.  18  and  19). 

The  partial  derivatives,  3d0i/3PLAT  and  3d0i/3PLONG,  can  be  expressed  fairly  explicitly 
using  the  following  argument.  Consider  a  geographical  location,  P,  and  a  VLF  station  location,  S,  as 
shown  in  Figure  37(a),  with  dpj,,  and  a^  the  distance,  phase,  and  azimuth  (i.e  heading)  respec¬ 
tively  from  P  to  S.  Consider,  also,  a  small  change  in  latitude  only,  ALAT,  in  going  from  point  P  to  a 
new  point,  P',  a  distance  dLAT  away.  Let  dp.^,  and  a'^  be  the  corresponding  distance,  phase, 
and  azimuth  from  P'  to  S.  Consider,  now,  the  relationship  between  Ad  =  dp -  dp^  and  dLAT. 

Based  on  Figure  37(a),  assume  that  a^  a'^,  since  dLAT  and  Ad  are  quite  small  while  dp^  and 
dp.j;  are  quite  large  distances.  It  then  holds  that 

Ad  =  -  cosa^  ’dLAT  (D2) 

The  relationship  between  dp^  and  <pp^  is  simply, 

dp^(nm)  =  Vj.(nm/iu  sec)  •  0p^(/i  sec)  (D3) 

where  is  the  speed  of  propagation  of  the  signal  transmitted  from  VLF  station  S.  The  substitution. 
Ad  =  Vg  •  A(/),  into  Equation  (D2)  yields 

Vj  ■  A0  -  cos  a^  •  dLAT  =  ~  cos  a^  •  60  •  ALAT  (D4) 


or 


A(p 

ALAT 


-60 

-  •  cos  a, 

V  ' 


In  the  limit  as  A LAT  -►  0,  Equation  (D5)  becomes 


(05) 


(06) 


In  similar  fashion,  based  on  the  geometry  depicted  in  Figure  37(b),  consider  a  small  change 
in  longitude  in  going  from  point  P  to  point  P'.  Using  the  same  kind  of  argument  as  before,  an  approx¬ 
imate  expression  for  Ad  can  be  determined  as. 


Ad  sin  a^  *  dLONG 


(D7) 


Substituting  Ad  =  ’  A^  and  dLONG  =  60  •  ALONG  •  cos(PLAT)  into  Equation  (D7)  yields 


Vg  *  A0  «=  sin  a^  •  60  •  ALONG  •  cos(PLAT) 


(D8) 


or 


A0 


60 


ALONG 


•  sin  a^  •  cos(PLAT) 


(D9 


and,  in  the  limit  as  ALONG  -*•  0,  Equation  (D9)  becomes 


60 

9d0g  /0PLONG  =  —  •  sin  a^ 


cos(PLAT) 


(DIO) 


Note  that  both  of  the  partial  derivatives,  3d(/>/dPLAT  and  dd^/dPLONG,  are  functions  of 
PLAT  and  PLONG  (since,  in  particular,  a^  is  a  function  of  PLAT,  PLONG).  Moreover,  for  any 
specified  geographicEil  position  (PLAT,  PLONG)  and  euiy  specified  VLF  station,  the  values  of  sin 
and  cos  a^  come  directly  out  of  the  Sodano  inverse  routine  as  it  is  programmed  at  NAE.  Equations 
(D6)  and  (DIO)  are  then  used  to  calculate  the  values  of  the  partial  derivatives  for  the  specified  posi¬ 
tion  and  VLF  station. 
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